source: codes/icosagcm/trunk/src/geometry.f90 @ 476

Last change on this file since 476 was 469, checked in by ymipsl, 8 years ago

Repairing openMP --> domain_update

YM

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