source: codes/icosagcm/trunk/src/sphere/geometry.f90 @ 814

Last change on this file since 814 was 814, checked in by adurocher, 5 years ago

trunk : removed double allocation of geom%bi in allocate_geometry

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