[1901] | 1 | ! |
---|
[6240] | 2 | ! $Id: modinterpbasic.F 2715 2011-03-30 15:58:35Z rblod $ |
---|
[1901] | 3 | ! |
---|
| 4 | C AGRIF (Adaptive Grid Refinement In Fortran) |
---|
| 5 | C |
---|
| 6 | C Copyright (C) 2003 Laurent Debreu (Laurent.Debreu@imag.fr) |
---|
| 7 | C Christophe Vouland (Christophe.Vouland@imag.fr) |
---|
| 8 | C |
---|
| 9 | C This program is free software; you can redistribute it and/or modify |
---|
| 10 | C it under the terms of the GNU General Public License as published by |
---|
| 11 | C the Free Software Foundation; either version 2 of the License, or |
---|
| 12 | C (at your option) any later version. |
---|
| 13 | C |
---|
| 14 | C This program is distributed in the hope that it will be useful, |
---|
| 15 | C but WITHOUT ANY WARRANTY; without even the implied warranty of |
---|
| 16 | C MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
---|
| 17 | C GNU General Public License for more details. |
---|
| 18 | C |
---|
| 19 | C You should have received a copy of the GNU General Public License |
---|
| 20 | C along with this program; if not, write to the Free Software |
---|
| 21 | C Foundation, Inc., 59 Temple Place- Suite 330, Boston, MA 02111-1307, USA. |
---|
| 22 | C |
---|
| 23 | C |
---|
| 24 | C |
---|
| 25 | CCC Module Agrif_Interpbasic |
---|
| 26 | C |
---|
| 27 | Module Agrif_Interpbasic |
---|
| 28 | C |
---|
| 29 | CCC Description: |
---|
| 30 | CCC Module containing different procedures of interpolation (linear,lagrange, |
---|
| 31 | CCC spline,...) used in the Agrif_Interpolation module. |
---|
| 32 | C |
---|
| 33 | C Modules used: |
---|
| 34 | USE Agrif_types |
---|
| 35 | C |
---|
| 36 | IMPLICIT NONE |
---|
| 37 | C |
---|
| 38 | Real,Dimension(Agrif_MaxRaff) :: tabdiff2, tabdiff3 |
---|
| 39 | Real,Dimension(5,Agrif_MaxRaff,3) :: tabppm |
---|
| 40 | Real,Dimension(:),Allocatable::tabtest4 |
---|
| 41 | Integer, Dimension(:,:), Allocatable :: indparent |
---|
| 42 | Integer, Dimension(:,:), Allocatable :: |
---|
| 43 | & indparentppm,indchildppm |
---|
| 44 | Integer, Dimension(:), Allocatable :: |
---|
| 45 | & indparentppm_1d,indchildppm_1d |
---|
| 46 | Real, Dimension(:,:),Allocatable :: coeffparent |
---|
| 47 | |
---|
| 48 | CONTAINS |
---|
| 49 | C Define procedures contained in this module |
---|
| 50 | C |
---|
| 51 | C ************************************************************************** |
---|
| 52 | CCC Subroutine Linear1d |
---|
| 53 | C ************************************************************************** |
---|
| 54 | C |
---|
| 55 | Subroutine Linear1d(x,y,np,nc, |
---|
| 56 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 57 | C |
---|
| 58 | CCC Description: |
---|
| 59 | CCC Subroutine to do a linear 1D interpolation on a child grid (vector y) from |
---|
| 60 | CCC its parent grid (vector x). |
---|
| 61 | C |
---|
| 62 | CC Method: |
---|
| 63 | C |
---|
| 64 | C Declarations: |
---|
| 65 | C |
---|
| 66 | |
---|
| 67 | C |
---|
| 68 | C Arguments |
---|
| 69 | INTEGER :: np,nc |
---|
| 70 | REAL,INTENT(IN), DIMENSION(np) :: x |
---|
| 71 | REAL,INTENT(OUT), DIMENSION(nc) :: y |
---|
| 72 | REAL :: s_parent,s_child,ds_parent,ds_child |
---|
| 73 | C |
---|
| 74 | C Local scalars |
---|
| 75 | INTEGER :: i,coeffraf,locind_parent_left |
---|
| 76 | REAL :: ypos,globind_parent_left,globind_parent_right |
---|
| 77 | REAL :: invds, invds2 |
---|
| 78 | REAL :: ypos2,diff |
---|
| 79 | C |
---|
| 80 | C |
---|
| 81 | |
---|
| 82 | coeffraf = nint(ds_parent/ds_child) |
---|
| 83 | C |
---|
| 84 | if (coeffraf == 1) then |
---|
| 85 | C |
---|
| 86 | locind_parent_left = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 87 | C |
---|
| 88 | y(1:nc) = x(locind_parent_left:locind_parent_left+nc-1) |
---|
| 89 | C |
---|
| 90 | return |
---|
| 91 | C |
---|
| 92 | endif |
---|
| 93 | C |
---|
| 94 | ypos = s_child |
---|
| 95 | |
---|
| 96 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 97 | |
---|
| 98 | globind_parent_left = s_parent |
---|
| 99 | & + (locind_parent_left - 1)*ds_parent |
---|
| 100 | |
---|
| 101 | globind_parent_right = globind_parent_left + ds_parent |
---|
| 102 | |
---|
| 103 | C |
---|
| 104 | invds = 1./ds_parent |
---|
| 105 | invds2 = ds_child/ds_parent |
---|
| 106 | |
---|
| 107 | ypos2 = ypos*invds |
---|
| 108 | globind_parent_right=globind_parent_right*invds |
---|
| 109 | |
---|
| 110 | do i = 1,nc-1 |
---|
| 111 | C |
---|
| 112 | if (ypos2 > globind_parent_right) then |
---|
| 113 | locind_parent_left = locind_parent_left + 1. |
---|
| 114 | globind_parent_right = globind_parent_right + 1. |
---|
[2715] | 115 | ypos2 = ypos*invds+(i-1)*invds2 |
---|
[1901] | 116 | endif |
---|
| 117 | |
---|
| 118 | diff=(globind_parent_right - ypos2) |
---|
| 119 | y(i) = (diff*x(locind_parent_left) |
---|
| 120 | & + (1.-diff)*x(locind_parent_left+1)) |
---|
| 121 | C |
---|
| 122 | ypos2 = ypos2 + invds2 |
---|
| 123 | C |
---|
| 124 | enddo |
---|
| 125 | C |
---|
| 126 | ypos = s_child + (nc-1)*ds_child |
---|
| 127 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 128 | C |
---|
| 129 | if (locind_parent_left == np) then |
---|
| 130 | C |
---|
| 131 | y(nc) = x(np) |
---|
| 132 | C |
---|
| 133 | else |
---|
| 134 | C |
---|
| 135 | globind_parent_left = s_parent |
---|
| 136 | & + (locind_parent_left - 1)*ds_parent |
---|
| 137 | C |
---|
| 138 | y(nc) = ((globind_parent_left + ds_parent - ypos) |
---|
| 139 | & *x(locind_parent_left) |
---|
| 140 | & + (ypos - globind_parent_left) |
---|
| 141 | & *x(locind_parent_left+1))*invds |
---|
| 142 | C |
---|
| 143 | endif |
---|
| 144 | C |
---|
| 145 | Return |
---|
| 146 | C |
---|
| 147 | C |
---|
| 148 | End Subroutine Linear1d |
---|
| 149 | |
---|
| 150 | Subroutine Linear1dprecompute2d(np2, np,nc, |
---|
| 151 | & s_parent,s_child,ds_parent,ds_child,dir) |
---|
| 152 | C |
---|
| 153 | CCC Description: |
---|
| 154 | CCC Subroutine to compute 2D coefficient and index for a linear 1D interpolation |
---|
| 155 | CCC on a child grid (vector y) from its parent grid (vector x). |
---|
| 156 | C |
---|
| 157 | CC Method: |
---|
| 158 | C |
---|
| 159 | C Declarations: |
---|
| 160 | C |
---|
| 161 | |
---|
| 162 | C |
---|
| 163 | C Arguments |
---|
| 164 | INTEGER :: np,nc,np2,dir |
---|
| 165 | REAL :: s_parent,s_child,ds_parent,ds_child |
---|
| 166 | C |
---|
| 167 | C Local scalars |
---|
| 168 | INTEGER :: i,j,coeffraf,locind_parent_left,inc,inc1,inc2,toto |
---|
| 169 | Integer, Dimension(:,:), Allocatable :: indparent_tmp |
---|
| 170 | Real, Dimension(:,:), Allocatable :: coeffparent_tmp |
---|
| 171 | REAL :: ypos,globind_parent_left,globind_parent_right |
---|
[2715] | 172 | REAL :: invds, invds2, invds3 |
---|
[1901] | 173 | REAL :: ypos2,diff |
---|
| 174 | C |
---|
| 175 | C |
---|
| 176 | |
---|
| 177 | coeffraf = nint(ds_parent/ds_child) |
---|
| 178 | C |
---|
| 179 | ypos = s_child |
---|
| 180 | |
---|
| 181 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 182 | |
---|
| 183 | globind_parent_left = s_parent |
---|
| 184 | & + (locind_parent_left - 1)*ds_parent |
---|
| 185 | |
---|
| 186 | globind_parent_right = globind_parent_left + ds_parent |
---|
| 187 | |
---|
| 188 | C |
---|
| 189 | invds = 1./ds_parent |
---|
| 190 | invds2 = ds_child/ds_parent |
---|
[2715] | 191 | invds3 = 0.5/real(coeffraf) |
---|
[1901] | 192 | |
---|
| 193 | ypos2 = ypos*invds |
---|
| 194 | globind_parent_right=globind_parent_right*invds |
---|
| 195 | |
---|
| 196 | if (.not.allocated(indparent)) then |
---|
| 197 | allocate(indparent(nc*np2,3),coeffparent(nc*np2,3)) |
---|
| 198 | else |
---|
| 199 | if (size(indparent,1)<nc*np2) then |
---|
| 200 | allocate(coeffparent_tmp(size(indparent,1),size(indparent,2))) |
---|
| 201 | allocate(indparent_tmp(size(indparent,1),size(indparent,2))) |
---|
| 202 | coeffparent_tmp=coeffparent |
---|
| 203 | indparent_tmp=indparent |
---|
| 204 | deallocate(indparent,coeffparent) |
---|
| 205 | allocate(indparent(nc*np2,3),coeffparent(nc*np2,3)) |
---|
| 206 | coeffparent(1:size(coeffparent_tmp,1),1:size(coeffparent_tmp,2)) |
---|
| 207 | & = coeffparent_tmp |
---|
| 208 | indparent(1:size(indparent_tmp,1),1:size(indparent_tmp,2)) |
---|
| 209 | & = indparent_tmp |
---|
| 210 | deallocate(indparent_tmp,coeffparent_tmp) |
---|
| 211 | endif |
---|
| 212 | endif |
---|
| 213 | |
---|
| 214 | do i = 1,nc-1 |
---|
| 215 | C |
---|
| 216 | if (ypos2 > globind_parent_right) then |
---|
| 217 | locind_parent_left = locind_parent_left + 1 |
---|
| 218 | globind_parent_right = globind_parent_right + 1. |
---|
[2715] | 219 | ypos2 = ypos*invds+(i-1)*invds2 |
---|
[1901] | 220 | endif |
---|
[2715] | 221 | |
---|
[1901] | 222 | diff=(globind_parent_right - ypos2) |
---|
[2715] | 223 | diff = invds3*nint(2*coeffraf*diff) |
---|
[1901] | 224 | indparent(i,dir) = locind_parent_left |
---|
[2715] | 225 | |
---|
[1901] | 226 | coeffparent(i,dir) = diff |
---|
| 227 | |
---|
| 228 | ypos2 = ypos2 + invds2 |
---|
| 229 | C |
---|
| 230 | enddo |
---|
| 231 | C |
---|
| 232 | ypos = s_child + (nc-1)*ds_child |
---|
| 233 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 234 | |
---|
| 235 | if (locind_parent_left == np) then |
---|
| 236 | indparent(nc,dir) = locind_parent_left-1 |
---|
| 237 | coeffparent(nc,dir) = 0. |
---|
| 238 | else |
---|
| 239 | C |
---|
| 240 | globind_parent_left = s_parent |
---|
| 241 | & + (locind_parent_left - 1)*ds_parent |
---|
| 242 | C |
---|
| 243 | indparent(nc,dir) = locind_parent_left |
---|
[2715] | 244 | diff = (globind_parent_left + ds_parent - ypos) |
---|
[1901] | 245 | & * invds |
---|
[2715] | 246 | diff = invds3*nint(2*coeffraf*diff) |
---|
| 247 | coeffparent(nc,dir) = diff |
---|
[1901] | 248 | endif |
---|
| 249 | |
---|
| 250 | do i=2, np2 |
---|
| 251 | inc = i*nc |
---|
| 252 | inc1 = (i-1)*nc |
---|
| 253 | inc2 = (i-2)*nc |
---|
| 254 | !CDIR ALTCODE |
---|
| 255 | indparent(1+inc1:inc,dir) = indparent(1+inc2:inc1,dir)+np |
---|
| 256 | !CDIR ALTCODE |
---|
| 257 | coeffparent(1+inc1:inc,dir) =coeffparent(1:nc,dir) |
---|
| 258 | enddo |
---|
| 259 | |
---|
| 260 | Return |
---|
| 261 | C |
---|
| 262 | C |
---|
| 263 | End Subroutine Linear1dprecompute2d |
---|
| 264 | |
---|
| 265 | |
---|
| 266 | |
---|
| 267 | Subroutine Linear1dprecompute(np,nc, |
---|
| 268 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 269 | C |
---|
| 270 | CCC Description: |
---|
| 271 | CCC Subroutine to compute 1D coefficient and index for a linear 1D interpolation |
---|
| 272 | CCC on a child grid (vector y) from its parent grid (vector x). |
---|
| 273 | C |
---|
| 274 | CC Method: |
---|
| 275 | C |
---|
| 276 | C Declarations: |
---|
| 277 | C |
---|
| 278 | |
---|
| 279 | C |
---|
| 280 | C Arguments |
---|
| 281 | INTEGER :: np,nc |
---|
| 282 | REAL :: s_parent,s_child,ds_parent,ds_child |
---|
| 283 | C |
---|
| 284 | C Local scalars |
---|
| 285 | INTEGER :: i,coeffraf,locind_parent_left |
---|
| 286 | REAL :: ypos,globind_parent_left,globind_parent_right |
---|
[2715] | 287 | REAL :: invds, invds2, invds3 |
---|
[1901] | 288 | REAL :: ypos2,diff |
---|
| 289 | C |
---|
| 290 | C |
---|
| 291 | |
---|
| 292 | coeffraf = nint(ds_parent/ds_child) |
---|
| 293 | C |
---|
| 294 | if (coeffraf == 1) then |
---|
| 295 | C |
---|
| 296 | return |
---|
| 297 | C |
---|
| 298 | endif |
---|
| 299 | C |
---|
| 300 | ypos = s_child |
---|
| 301 | |
---|
| 302 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 303 | |
---|
| 304 | globind_parent_left = s_parent |
---|
| 305 | & + (locind_parent_left - 1)*ds_parent |
---|
| 306 | |
---|
| 307 | globind_parent_right = globind_parent_left + ds_parent |
---|
| 308 | |
---|
| 309 | C |
---|
| 310 | invds = 1./ds_parent |
---|
| 311 | invds2 = ds_child/ds_parent |
---|
[2715] | 312 | invds3 = 0.5/real(coeffraf) |
---|
[1901] | 313 | |
---|
| 314 | ypos2 = ypos*invds |
---|
| 315 | globind_parent_right=globind_parent_right*invds |
---|
| 316 | |
---|
| 317 | if (.not.allocated(indparent)) then |
---|
| 318 | allocate(indparent(nc,1),coeffparent(nc,1)) |
---|
| 319 | else |
---|
| 320 | if (size(indparent)<nc) then |
---|
| 321 | deallocate(indparent,coeffparent) |
---|
| 322 | allocate(indparent(nc,1),coeffparent(nc,1)) |
---|
| 323 | endif |
---|
| 324 | endif |
---|
| 325 | |
---|
| 326 | do i = 1,nc-1 |
---|
| 327 | C |
---|
| 328 | if (ypos2 > globind_parent_right) then |
---|
| 329 | locind_parent_left = locind_parent_left + 1 |
---|
| 330 | globind_parent_right = globind_parent_right + 1. |
---|
[2715] | 331 | ypos2 = ypos*invds+(i-1)*invds2 |
---|
[1901] | 332 | endif |
---|
| 333 | |
---|
| 334 | diff=(globind_parent_right - ypos2) |
---|
[2715] | 335 | |
---|
| 336 | diff = invds3*nint(2*coeffraf*diff) |
---|
| 337 | |
---|
[1901] | 338 | indparent(i,1) = locind_parent_left |
---|
[2715] | 339 | |
---|
[1901] | 340 | coeffparent(i,1) = diff |
---|
| 341 | ypos2 = ypos2 + invds2 |
---|
| 342 | C |
---|
| 343 | enddo |
---|
| 344 | C |
---|
| 345 | ypos = s_child + (nc-1)*ds_child |
---|
| 346 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 347 | |
---|
| 348 | if (locind_parent_left == np) then |
---|
| 349 | indparent(nc,1) = locind_parent_left-1 |
---|
| 350 | coeffparent(nc,1) = 0. |
---|
| 351 | else |
---|
| 352 | C |
---|
| 353 | globind_parent_left = s_parent |
---|
| 354 | & + (locind_parent_left - 1)*ds_parent |
---|
| 355 | C |
---|
| 356 | indparent(nc,1) = locind_parent_left |
---|
| 357 | |
---|
[2715] | 358 | diff = (globind_parent_left + ds_parent - ypos) |
---|
[1901] | 359 | & * invds |
---|
[2715] | 360 | diff = invds3*nint(2*coeffraf*diff) |
---|
| 361 | coeffparent(nc,1) = diff |
---|
[1901] | 362 | endif |
---|
| 363 | C |
---|
| 364 | Return |
---|
| 365 | C |
---|
| 366 | C |
---|
| 367 | End Subroutine Linear1dprecompute |
---|
| 368 | |
---|
| 369 | Subroutine Linear1daftercompute(x,y,np,nc, |
---|
| 370 | & s_parent,s_child,ds_parent,ds_child,dir) |
---|
| 371 | C |
---|
| 372 | CCC Description: |
---|
| 373 | CCC Subroutine to do a linear 1D interpolation on a child grid (vector y) from |
---|
| 374 | CCC its parent grid (vector x) using precomputed coefficient and index. |
---|
| 375 | C |
---|
| 376 | CC Method: |
---|
| 377 | C |
---|
| 378 | C Declarations: |
---|
| 379 | C |
---|
| 380 | |
---|
| 381 | C |
---|
| 382 | C Arguments |
---|
| 383 | INTEGER :: np,nc,dir |
---|
| 384 | REAL,INTENT(IN), DIMENSION(np) :: x |
---|
| 385 | REAL,INTENT(OUT), DIMENSION(nc) :: y |
---|
| 386 | REAL :: s_parent,s_child,ds_parent,ds_child |
---|
| 387 | C |
---|
| 388 | C Local scalars |
---|
| 389 | INTEGER :: i,coeffraf,locind_parent_left |
---|
| 390 | REAL :: ypos,globind_parent_left,globind_parent_right |
---|
| 391 | REAL :: invds, invds2 |
---|
| 392 | REAL :: ypos2,diff |
---|
| 393 | C |
---|
| 394 | C |
---|
| 395 | |
---|
| 396 | !CDIR ALTCODE |
---|
| 397 | !CDIR NODEP |
---|
| 398 | do i = 1,nc |
---|
| 399 | C |
---|
| 400 | y(i)=coeffparent(i,dir)*x(MAX(indparent(i,dir),1))+ |
---|
| 401 | & (1.-coeffparent(i,dir))*x(indparent(i,dir)+1) |
---|
| 402 | C |
---|
| 403 | enddo |
---|
| 404 | C |
---|
| 405 | Return |
---|
| 406 | C |
---|
| 407 | C |
---|
| 408 | End Subroutine Linear1daftercompute |
---|
| 409 | |
---|
| 410 | C |
---|
| 411 | C |
---|
| 412 | C |
---|
| 413 | C ************************************************************************** |
---|
| 414 | CCC Subroutine Lagrange1d |
---|
| 415 | C ************************************************************************** |
---|
| 416 | C |
---|
| 417 | Subroutine Lagrange1d(x,y,np,nc, |
---|
| 418 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 419 | C |
---|
| 420 | CCC Description: |
---|
| 421 | CCC Subroutine to do a lagrange 1D interpolation on a child grid (vector y) |
---|
| 422 | CCC from its parent grid (vector x). |
---|
| 423 | C |
---|
| 424 | CC Method: |
---|
| 425 | C |
---|
| 426 | C Declarations: |
---|
| 427 | C |
---|
| 428 | |
---|
| 429 | C |
---|
| 430 | C Arguments |
---|
| 431 | INTEGER :: np,nc |
---|
| 432 | REAL,INTENT(IN), DIMENSION(np) :: x |
---|
| 433 | REAL,INTENT(OUT), DIMENSION(nc) :: y |
---|
| 434 | REAL :: s_parent,s_child,ds_parent,ds_child |
---|
| 435 | C |
---|
| 436 | C Local scalars |
---|
| 437 | INTEGER :: i,coeffraf,locind_parent_left |
---|
| 438 | REAL :: ypos,globind_parent_left |
---|
| 439 | REAL :: X1,X2,X3 |
---|
| 440 | real :: deltax,invdsparent |
---|
| 441 | real t1,t2,t3,t4,t5,t6,t7,t8 |
---|
| 442 | C |
---|
| 443 | C |
---|
| 444 | if (np <= 2) then |
---|
| 445 | C |
---|
| 446 | Call Linear1D(x,y,np,nc, |
---|
| 447 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 448 | C |
---|
| 449 | Return |
---|
| 450 | C |
---|
| 451 | endif |
---|
| 452 | C |
---|
| 453 | coeffraf = nint(ds_parent/ds_child) |
---|
| 454 | C |
---|
| 455 | if (coeffraf == 1) then |
---|
| 456 | C |
---|
| 457 | locind_parent_left = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 458 | C |
---|
| 459 | y(1:nc) = x(locind_parent_left:locind_parent_left+nc-1) |
---|
| 460 | C |
---|
| 461 | return |
---|
| 462 | C |
---|
| 463 | endif |
---|
| 464 | |
---|
| 465 | invdsparent=1./ds_parent |
---|
| 466 | C |
---|
| 467 | ypos = s_child |
---|
| 468 | C |
---|
| 469 | do i = 1,nc |
---|
| 470 | C |
---|
| 471 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 472 | C |
---|
| 473 | |
---|
| 474 | globind_parent_left = s_parent |
---|
| 475 | & + (locind_parent_left - 1)*ds_parent |
---|
| 476 | |
---|
[2715] | 477 | C deltax = invdsparent*(ypos-globind_parent_left) |
---|
| 478 | deltax = nint(coeffraf*deltax)/real(coeffraf) |
---|
| 479 | |
---|
[1901] | 480 | ypos = ypos + ds_child |
---|
| 481 | if (abs(deltax).LE.0.0001) then |
---|
| 482 | y(i)=x(locind_parent_left) |
---|
| 483 | |
---|
| 484 | cycle |
---|
| 485 | endif |
---|
| 486 | C |
---|
| 487 | C |
---|
| 488 | t2 = deltax - 2. |
---|
| 489 | t3 = deltax - 1. |
---|
| 490 | t4 = deltax + 1. |
---|
| 491 | |
---|
| 492 | t5 = -(1./6.)*deltax*t2*t3 |
---|
| 493 | t6 = 0.5*t2*t3*t4 |
---|
| 494 | t7 = -0.5*deltax*t2*t4 |
---|
| 495 | t8 = (1./6.)*deltax*t3*t4 |
---|
| 496 | |
---|
| 497 | y(i)=t5*x(locind_parent_left-1)+t6*x(locind_parent_left) |
---|
| 498 | & +t7*x(locind_parent_left+1)+t8*x(locind_parent_left+2) |
---|
| 499 | C |
---|
| 500 | C |
---|
| 501 | enddo |
---|
| 502 | C |
---|
| 503 | return |
---|
| 504 | C |
---|
| 505 | C |
---|
| 506 | End Subroutine Lagrange1d |
---|
| 507 | C |
---|
| 508 | C |
---|
| 509 | C ************************************************************************** |
---|
| 510 | CCC Subroutine Constant1d |
---|
| 511 | C ************************************************************************** |
---|
| 512 | C |
---|
| 513 | Subroutine constant1d(x,y,np,nc, |
---|
| 514 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 515 | C |
---|
| 516 | CCC Description: |
---|
| 517 | CCC Subroutine to do a linear 1D interpolation on a child grid (vector y) from |
---|
| 518 | CCC its parent grid (vector x). |
---|
| 519 | C |
---|
| 520 | CC Method: |
---|
| 521 | C |
---|
| 522 | C Declarations: |
---|
| 523 | C |
---|
| 524 | |
---|
| 525 | C |
---|
| 526 | C Arguments |
---|
| 527 | INTEGER :: np,nc |
---|
| 528 | REAL,INTENT(IN), DIMENSION(np) :: x |
---|
| 529 | REAL,INTENT(OUT), DIMENSION(nc) :: y |
---|
| 530 | REAL :: s_parent,s_child,ds_parent,ds_child |
---|
| 531 | C |
---|
| 532 | C Local scalars |
---|
| 533 | INTEGER :: i,coeffraf,locind_parent |
---|
| 534 | REAL :: ypos |
---|
| 535 | C |
---|
| 536 | C |
---|
| 537 | |
---|
| 538 | coeffraf = nint(ds_parent/ds_child) |
---|
| 539 | C |
---|
| 540 | if (coeffraf == 1) then |
---|
| 541 | C |
---|
| 542 | locind_parent = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 543 | C |
---|
| 544 | y(1:nc) = x(locind_parent:locind_parent+nc-1) |
---|
| 545 | C |
---|
| 546 | return |
---|
| 547 | C |
---|
| 548 | endif |
---|
| 549 | C |
---|
| 550 | ypos = s_child |
---|
| 551 | C |
---|
| 552 | do i = 1,nc |
---|
| 553 | C |
---|
| 554 | locind_parent = 1 + nint((ypos - s_parent)/ds_parent) |
---|
| 555 | C |
---|
| 556 | y(i) = x(locind_parent) |
---|
| 557 | C |
---|
| 558 | ypos = ypos + ds_child |
---|
| 559 | C |
---|
| 560 | enddo |
---|
| 561 | C |
---|
| 562 | Return |
---|
| 563 | C |
---|
| 564 | C |
---|
| 565 | End Subroutine constant1d |
---|
| 566 | C |
---|
| 567 | C ************************************************************************** |
---|
| 568 | CCC Subroutine Linear1dconserv |
---|
| 569 | C ************************************************************************** |
---|
| 570 | C |
---|
| 571 | Subroutine Linear1dconserv(x,y,np,nc, |
---|
| 572 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 573 | C |
---|
| 574 | CCC Description: |
---|
| 575 | CCC Subroutine to do a linear 1D interpolation on a child grid (vector y) from |
---|
| 576 | CCC its parent grid (vector x). |
---|
| 577 | C |
---|
| 578 | CC Method: |
---|
| 579 | C |
---|
| 580 | C Declarations: |
---|
| 581 | C |
---|
| 582 | Implicit none |
---|
| 583 | C |
---|
| 584 | C Arguments |
---|
| 585 | Integer :: np,nc |
---|
| 586 | Real, Dimension(np) :: x |
---|
| 587 | Real, Dimension(nc) :: y |
---|
| 588 | Real, Dimension(:),Allocatable :: ytemp |
---|
| 589 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 590 | C |
---|
| 591 | C Local scalars |
---|
| 592 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 593 | Real :: ypos |
---|
| 594 | integer :: i1,i2,ii |
---|
| 595 | real :: xpmin,xpmax,slope |
---|
| 596 | INTEGER :: diffmod |
---|
| 597 | REAL :: xdiffmod |
---|
| 598 | |
---|
| 599 | C |
---|
| 600 | C |
---|
| 601 | |
---|
| 602 | coeffraf = nint(ds_parent/ds_child) |
---|
| 603 | C |
---|
| 604 | If (coeffraf == 1) Then |
---|
| 605 | C |
---|
| 606 | locind_parent_left = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 607 | C |
---|
| 608 | y(1:nc) = x(locind_parent_left:locind_parent_left+nc-1) |
---|
| 609 | C |
---|
| 610 | return |
---|
| 611 | C |
---|
| 612 | End If |
---|
| 613 | C |
---|
| 614 | diffmod = 0 |
---|
| 615 | IF (mod(coeffraf,2) == 0) diffmod = 1 |
---|
| 616 | |
---|
| 617 | xdiffmod = real(diffmod)/2. |
---|
| 618 | |
---|
| 619 | allocate(ytemp(-2*coeffraf:nc+2*coeffraf)) |
---|
| 620 | C |
---|
| 621 | ypos = s_child |
---|
| 622 | C |
---|
| 623 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 624 | |
---|
| 625 | locind_parent_last = 1 + |
---|
| 626 | & agrif_ceiling((ypos +(nc - 1) *ds_child - s_parent)/ds_parent) |
---|
| 627 | |
---|
| 628 | xpmin = s_parent + (locind_parent_left-1)*ds_parent |
---|
| 629 | xpmax = s_parent + (locind_parent_last-1)*ds_parent |
---|
| 630 | |
---|
| 631 | i1 = 1+agrif_int((xpmin-s_child)/ds_child) |
---|
| 632 | i2 = 1+agrif_int((xpmax-s_child)/ds_child) |
---|
| 633 | |
---|
| 634 | i = i1 |
---|
| 635 | |
---|
| 636 | if (locind_parent_left == 1) then |
---|
| 637 | slope= |
---|
| 638 | & (x(locind_parent_left+1)-x(locind_parent_left))/(coeffraf) |
---|
| 639 | else |
---|
| 640 | slope= |
---|
| 641 | & (x(locind_parent_left+1)-x(locind_parent_left-1))/(2.*coeffraf) |
---|
| 642 | endif |
---|
| 643 | |
---|
| 644 | do ii=i-coeffraf/2+diffmod,i+coeffraf/2 |
---|
| 645 | ytemp(ii) = x(locind_parent_left)+(ii-i-xdiffmod/2.)*slope |
---|
| 646 | enddo |
---|
| 647 | |
---|
| 648 | locind_parent_left = locind_parent_left + 1 |
---|
| 649 | |
---|
| 650 | do i=i1 + coeffraf, i2 - coeffraf,coeffraf |
---|
| 651 | slope= |
---|
| 652 | & (x(locind_parent_left+1)-x(locind_parent_left-1))/(2.*coeffraf) |
---|
| 653 | do ii=i-coeffraf/2+diffmod,i+coeffraf/2 |
---|
| 654 | ytemp(ii) = x(locind_parent_left)+(ii-i-xdiffmod/2.)*slope |
---|
| 655 | enddo |
---|
| 656 | locind_parent_left = locind_parent_left + 1 |
---|
| 657 | enddo |
---|
| 658 | |
---|
| 659 | i = i2 |
---|
| 660 | |
---|
| 661 | if (locind_parent_left == np) then |
---|
| 662 | slope= |
---|
| 663 | & (x(locind_parent_left)-x(locind_parent_left-1))/(coeffraf) |
---|
| 664 | else |
---|
| 665 | slope= |
---|
| 666 | & (x(locind_parent_left+1)-x(locind_parent_left-1))/(2.*coeffraf) |
---|
| 667 | endif |
---|
| 668 | |
---|
| 669 | do ii=i-coeffraf/2+diffmod,nc |
---|
| 670 | ytemp(ii) = x(locind_parent_left)+(ii-i-xdiffmod/2.)*slope |
---|
| 671 | enddo |
---|
| 672 | C |
---|
| 673 | y(1:nc)=ytemp(1:nc) |
---|
| 674 | C |
---|
| 675 | deallocate(ytemp) |
---|
| 676 | Return |
---|
| 677 | C |
---|
| 678 | End Subroutine Linear1dconserv |
---|
| 679 | |
---|
| 680 | C |
---|
| 681 | C ************************************************************************** |
---|
| 682 | CCC Subroutine Linear1dconservlim |
---|
| 683 | C ************************************************************************** |
---|
| 684 | C |
---|
| 685 | Subroutine Linear1dconservlim(x,y,np,nc, |
---|
| 686 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 687 | C |
---|
| 688 | CCC Description: |
---|
| 689 | CCC Subroutine to do a linear 1D interpolation on a child grid (vector y) from |
---|
| 690 | CCC its parent grid (vector x). |
---|
| 691 | C |
---|
| 692 | CC Method: |
---|
| 693 | C |
---|
| 694 | C Declarations: |
---|
| 695 | C |
---|
| 696 | Implicit none |
---|
| 697 | C |
---|
| 698 | C Arguments |
---|
| 699 | Integer :: np,nc |
---|
| 700 | Real, Dimension(np) :: x |
---|
| 701 | Real, Dimension(nc) :: y |
---|
| 702 | Real, Dimension(:),Allocatable :: ytemp |
---|
| 703 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 704 | C |
---|
| 705 | C Local scalars |
---|
| 706 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 707 | Real :: ypos |
---|
| 708 | integer :: i1,i2,ii |
---|
| 709 | real :: xpmin,xpmax,slope |
---|
| 710 | INTEGER :: diffmod |
---|
| 711 | real :: xdiffmod |
---|
| 712 | C |
---|
| 713 | C |
---|
| 714 | |
---|
| 715 | coeffraf = nint(ds_parent/ds_child) |
---|
| 716 | C |
---|
| 717 | If (coeffraf == 1) Then |
---|
| 718 | C |
---|
| 719 | locind_parent_left = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 720 | C |
---|
| 721 | y(1:nc) = x(locind_parent_left:locind_parent_left+nc-1) |
---|
| 722 | C |
---|
| 723 | return |
---|
| 724 | C |
---|
| 725 | End If |
---|
| 726 | C |
---|
| 727 | IF (coeffraf .NE.3) THEN |
---|
| 728 | print *,'LINEARCONSERVLIM not ready for refinement ratio = ', |
---|
| 729 | & coeffraf |
---|
| 730 | stop |
---|
| 731 | ENDIF |
---|
| 732 | |
---|
| 733 | diffmod = 0 |
---|
| 734 | IF (mod(coeffraf,2) == 0) diffmod = 1 |
---|
| 735 | |
---|
| 736 | xdiffmod = real(diffmod)/2. |
---|
| 737 | |
---|
| 738 | allocate(ytemp(-2*coeffraf:nc+2*coeffraf)) |
---|
| 739 | C |
---|
| 740 | ypos = s_child |
---|
| 741 | C |
---|
| 742 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 743 | |
---|
| 744 | locind_parent_last = 1 + |
---|
| 745 | & agrif_ceiling((ypos +(nc - 1) *ds_child - s_parent)/ds_parent) |
---|
| 746 | |
---|
| 747 | xpmin = s_parent + (locind_parent_left-1)*ds_parent |
---|
| 748 | xpmax = s_parent + (locind_parent_last-1)*ds_parent |
---|
| 749 | |
---|
| 750 | i1 = 1+agrif_int((xpmin-s_child)/ds_child) |
---|
| 751 | i2 = 1+agrif_int((xpmax-s_child)/ds_child) |
---|
| 752 | |
---|
| 753 | i = i1 |
---|
| 754 | |
---|
| 755 | if (locind_parent_left == 1) then |
---|
| 756 | slope=0. |
---|
| 757 | else |
---|
| 758 | slope = vanleer(x(locind_parent_left-1:locind_parent_left+1)) |
---|
| 759 | slope = slope / coeffraf |
---|
| 760 | endif |
---|
| 761 | |
---|
| 762 | do ii=i-coeffraf/2+diffmod,i+coeffraf/2 |
---|
| 763 | ytemp(ii) = x(locind_parent_left)+(ii-i-xdiffmod/2.)*slope |
---|
| 764 | enddo |
---|
| 765 | |
---|
| 766 | locind_parent_left = locind_parent_left + 1 |
---|
| 767 | |
---|
| 768 | do i=i1 + coeffraf, i2 - coeffraf,coeffraf |
---|
| 769 | slope = vanleer(x(locind_parent_left-1:locind_parent_left+1)) |
---|
| 770 | slope = slope / coeffraf |
---|
| 771 | |
---|
| 772 | do ii=i-coeffraf/2+diffmod,i+coeffraf/2 |
---|
| 773 | ytemp(ii) = x(locind_parent_left)+(ii-i-xdiffmod/2.)*slope |
---|
| 774 | enddo |
---|
| 775 | locind_parent_left = locind_parent_left + 1 |
---|
| 776 | enddo |
---|
| 777 | |
---|
| 778 | i = i2 |
---|
| 779 | |
---|
| 780 | if (locind_parent_left == np) then |
---|
| 781 | slope=0. |
---|
| 782 | else |
---|
| 783 | slope = vanleer(x(locind_parent_left-1:locind_parent_left+1)) |
---|
| 784 | slope = slope / coeffraf |
---|
| 785 | endif |
---|
| 786 | |
---|
| 787 | do ii=i-coeffraf/2+diffmod,nc |
---|
| 788 | ytemp(ii) = x(locind_parent_left)+(ii-i-xdiffmod/2.)*slope |
---|
| 789 | enddo |
---|
| 790 | C |
---|
| 791 | y(1:nc)=ytemp(1:nc) |
---|
| 792 | C |
---|
| 793 | deallocate(ytemp) |
---|
| 794 | Return |
---|
| 795 | C |
---|
| 796 | End Subroutine Linear1dconservlim |
---|
| 797 | C |
---|
| 798 | |
---|
| 799 | C ************************************************************************** |
---|
| 800 | CCC Subroutine ppm1d |
---|
| 801 | C ************************************************************************** |
---|
| 802 | C |
---|
| 803 | Subroutine ppm1d(x,y,np,nc, |
---|
| 804 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 805 | C |
---|
| 806 | CCC Description: |
---|
| 807 | CCC Subroutine to do a 1D interpolation and apply monotonicity constraints |
---|
| 808 | CCC using piecewise parabolic method |
---|
| 809 | CCC on a child grid (vector y) from its parent grid (vector x). |
---|
| 810 | CC Method: |
---|
| 811 | C |
---|
| 812 | C Declarations: |
---|
| 813 | C |
---|
| 814 | Implicit none |
---|
| 815 | C |
---|
| 816 | C Arguments |
---|
| 817 | Integer :: np,nc |
---|
| 818 | Real, INTENT(IN),Dimension(np) :: x |
---|
| 819 | Real, INTENT(OUT),Dimension(nc) :: y |
---|
| 820 | C Real, Dimension(:),Allocatable :: ytemp |
---|
| 821 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 822 | C |
---|
| 823 | C Local scalars |
---|
| 824 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 825 | Integer :: iparent,ipos,pos,nmin,nmax |
---|
| 826 | Real :: ypos |
---|
| 827 | integer :: i1,jj |
---|
| 828 | Real :: xpmin,a |
---|
| 829 | C |
---|
| 830 | Real :: xrmin,xrmax,am3,s2,s1 |
---|
| 831 | Real, Dimension(np) :: xl,delta,a6,slope |
---|
| 832 | C Real, Dimension(:),Allocatable :: diff,diff2,diff3 |
---|
| 833 | INTEGER :: diffmod |
---|
| 834 | REAL :: invcoeffraf |
---|
| 835 | C |
---|
| 836 | coeffraf = nint(ds_parent/ds_child) |
---|
| 837 | C |
---|
| 838 | If (coeffraf == 1) Then |
---|
| 839 | locind_parent_left = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 840 | !CDIR ALTCODE |
---|
| 841 | !CDIR SHORTLOOP |
---|
| 842 | y(1:nc) = x(locind_parent_left:locind_parent_left+nc-1) |
---|
| 843 | return |
---|
| 844 | End If |
---|
| 845 | invcoeffraf = ds_child/ds_parent |
---|
| 846 | C |
---|
| 847 | |
---|
| 848 | IF( .NOT. allocated(tabtest4) ) THEN |
---|
| 849 | Allocate(tabtest4(-2*coeffraf:nc+2*coeffraf)) |
---|
| 850 | ELSE |
---|
| 851 | IF (size(tabtest4) .LT. nc+4*coeffraf+1)THEN |
---|
| 852 | deallocate( tabtest4 ) |
---|
| 853 | Allocate(tabtest4(-2*coeffraf:nc+2*coeffraf)) |
---|
| 854 | ENDIF |
---|
| 855 | ENDIF |
---|
| 856 | |
---|
| 857 | ypos = s_child |
---|
| 858 | C |
---|
| 859 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 860 | locind_parent_last = 1 + |
---|
| 861 | & agrif_ceiling((ypos +(nc - 1) |
---|
| 862 | & *ds_child - s_parent)/ds_parent) |
---|
| 863 | C |
---|
| 864 | xpmin = s_parent + (locind_parent_left-1)*ds_parent |
---|
| 865 | i1 = 1+agrif_int((xpmin-s_child)/ds_child) |
---|
| 866 | C |
---|
| 867 | C |
---|
| 868 | |
---|
| 869 | !CDIR NOVECTOR |
---|
| 870 | Do i=1,coeffraf |
---|
| 871 | tabdiff2(i)=(real(i)-0.5)*invcoeffraf |
---|
| 872 | EndDo |
---|
| 873 | |
---|
| 874 | a = invcoeffraf**2 |
---|
| 875 | tabdiff3(1) = (1./3.)*a |
---|
| 876 | a=2.*a |
---|
| 877 | !CDIR NOVECTOR |
---|
| 878 | Do i=2,coeffraf |
---|
| 879 | tabdiff3(i) = tabdiff3(i-1)+(real(i)-1)*a |
---|
| 880 | EndDo |
---|
| 881 | C |
---|
| 882 | if( locind_parent_last+2 <= np ) then |
---|
| 883 | nmax = locind_parent_last+2 |
---|
| 884 | else if( locind_parent_last+1 <= np ) then |
---|
| 885 | nmax = locind_parent_last+1 |
---|
| 886 | else |
---|
| 887 | nmax = locind_parent_last |
---|
| 888 | endif |
---|
| 889 | C |
---|
| 890 | if(locind_parent_left-1 >= 1) then |
---|
| 891 | nmin = locind_parent_left-1 |
---|
| 892 | else |
---|
| 893 | nmin = locind_parent_left |
---|
| 894 | endif |
---|
| 895 | C |
---|
| 896 | C |
---|
| 897 | !CDIR ALTCODE |
---|
| 898 | !CDIR SHORTLOOP |
---|
| 899 | Do i = nmin,nmax |
---|
| 900 | slope(i) = x(i) - x(i-1) |
---|
| 901 | Enddo |
---|
| 902 | |
---|
| 903 | !CDIR ALTCODE |
---|
| 904 | !CDIR SHORTLOOP |
---|
| 905 | Do i = nmin+1,nmax-1 |
---|
| 906 | xl(i)= 0.5*(x(i-1)+x(i)) |
---|
| 907 | & -0.08333333333333*(slope(i+1)-slope(i-1)) |
---|
| 908 | Enddo |
---|
| 909 | C |
---|
| 910 | C apply parabolic monotonicity |
---|
| 911 | !CDIR ALTCODE |
---|
| 912 | !CDIR SHORTLOOP |
---|
| 913 | Do i = locind_parent_left,locind_parent_last |
---|
| 914 | delta(i) = xl(i+1) - xl(i) |
---|
| 915 | a6(i) = 6.*x(i)-3.*(xl(i) +xl(i+1)) |
---|
| 916 | C |
---|
| 917 | End do |
---|
| 918 | C |
---|
| 919 | diffmod = 0 |
---|
| 920 | IF (mod(coeffraf,2) == 0) diffmod = 1 |
---|
| 921 | C |
---|
| 922 | ipos = i1 |
---|
| 923 | C |
---|
| 924 | Do iparent = locind_parent_left,locind_parent_last |
---|
| 925 | pos=1 |
---|
| 926 | !CDIR ALTCODE |
---|
| 927 | !CDIR SHORTLOOP |
---|
| 928 | Do jj = ipos - coeffraf/2+diffmod,ipos + coeffraf/2 |
---|
| 929 | C |
---|
| 930 | tabtest4(jj) = xl(iparent) |
---|
| 931 | & + tabdiff2(pos) * (delta(iparent)+a6(iparent)) |
---|
| 932 | & - tabdiff3(pos) * a6(iparent) |
---|
| 933 | pos = pos+1 |
---|
| 934 | End do |
---|
| 935 | ipos = ipos + coeffraf |
---|
| 936 | C |
---|
| 937 | End do |
---|
| 938 | C |
---|
| 939 | C |
---|
| 940 | !CDIR ALTCODE |
---|
| 941 | !CDIR SHORTLOOP |
---|
| 942 | y(1:nc)=tabtest4(1:nc) |
---|
| 943 | |
---|
| 944 | Return |
---|
| 945 | End Subroutine ppm1d |
---|
| 946 | |
---|
| 947 | |
---|
| 948 | Subroutine ppm1dprecompute2d(np2,np,nc, |
---|
| 949 | & s_parent,s_child,ds_parent,ds_child,dir) |
---|
| 950 | C |
---|
| 951 | CCC Description: |
---|
| 952 | CCC Subroutine to compute 2D coefficients and index for a 1D interpolation |
---|
| 953 | CCC using piecewise parabolic method |
---|
| 954 | CC Method: |
---|
| 955 | C |
---|
| 956 | C Declarations: |
---|
| 957 | C |
---|
| 958 | Implicit none |
---|
| 959 | C |
---|
| 960 | C Arguments |
---|
| 961 | Integer :: np2,np,nc,dir |
---|
| 962 | C Real, Dimension(:),Allocatable :: ytemp |
---|
| 963 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 964 | C |
---|
| 965 | C Local scalars |
---|
| 966 | Integer, Dimension(:,:), Allocatable :: indparent_tmp |
---|
| 967 | Integer, Dimension(:,:), Allocatable :: indchild_tmp |
---|
| 968 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 969 | Integer :: iparent,ipos,pos,nmin,nmax |
---|
| 970 | Real :: ypos |
---|
| 971 | integer :: i1,jj |
---|
| 972 | Real :: xpmin,a |
---|
| 973 | C |
---|
| 974 | Real :: xrmin,xrmax,am3,s2,s1 |
---|
| 975 | Real, Dimension(np) :: xl,delta,a6,slope |
---|
| 976 | INTEGER :: diffmod |
---|
| 977 | REAL :: invcoeffraf |
---|
| 978 | C |
---|
| 979 | coeffraf = nint(ds_parent/ds_child) |
---|
| 980 | C |
---|
| 981 | invcoeffraf = ds_child/ds_parent |
---|
| 982 | C |
---|
| 983 | |
---|
| 984 | if (.not.allocated(indparentppm)) then |
---|
| 985 | allocate( |
---|
| 986 | & indparentppm(np2*nc,3), |
---|
| 987 | & indchildppm(np2*nc,3) |
---|
| 988 | & ) |
---|
| 989 | else |
---|
| 990 | if (size(indparentppm,1)<np2*nc) then |
---|
| 991 | allocate( |
---|
| 992 | & indparent_tmp(size(indparentppm,1),size(indparentppm,2)), |
---|
| 993 | & indchild_tmp(size(indparentppm,1),size(indparentppm,2))) |
---|
| 994 | indparent_tmp = indparentppm |
---|
| 995 | indchild_tmp = indchildppm |
---|
| 996 | deallocate(indparentppm,indchildppm) |
---|
| 997 | allocate( |
---|
| 998 | &indparentppm(np2*nc,3), |
---|
| 999 | &indchildppm(np2*nc,3) |
---|
| 1000 | & ) |
---|
| 1001 | indparentppm(1:size(indparent_tmp,1),1:size(indparent_tmp,2)) |
---|
| 1002 | & = indparent_tmp |
---|
| 1003 | indchildppm(1:size(indparent_tmp,1),1:size(indparent_tmp,2)) |
---|
| 1004 | & = indchild_tmp |
---|
| 1005 | deallocate(indparent_tmp,indchild_tmp) |
---|
| 1006 | endif |
---|
| 1007 | endif |
---|
| 1008 | |
---|
| 1009 | if (.not.allocated(indparentppm_1d)) then |
---|
| 1010 | allocate(indparentppm_1d(-2*coeffraf:nc+2*coeffraf), |
---|
| 1011 | & indchildppm_1d(-2*coeffraf:nc+2*coeffraf)) |
---|
| 1012 | else |
---|
| 1013 | if (size(indparentppm_1d)<nc+4*coeffraf+1) then |
---|
| 1014 | deallocate(indparentppm_1d,indchildppm_1d) |
---|
| 1015 | allocate(indparentppm_1d(-2*coeffraf:nc+2*coeffraf), |
---|
| 1016 | & indchildppm_1d(-2*coeffraf:nc+2*coeffraf)) |
---|
| 1017 | endif |
---|
| 1018 | endif |
---|
| 1019 | |
---|
| 1020 | |
---|
| 1021 | ypos = s_child |
---|
| 1022 | C |
---|
| 1023 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 1024 | locind_parent_last = 1 + |
---|
| 1025 | & agrif_ceiling((ypos +(nc - 1) |
---|
| 1026 | & *ds_child - s_parent)/ds_parent) |
---|
| 1027 | C |
---|
| 1028 | xpmin = s_parent + (locind_parent_left-1)*ds_parent |
---|
| 1029 | i1 = 1+agrif_int((xpmin-s_child)/ds_child) |
---|
| 1030 | C |
---|
| 1031 | C |
---|
| 1032 | |
---|
| 1033 | Do i=1,coeffraf |
---|
| 1034 | tabdiff2(i)=(real(i)-0.5)*invcoeffraf |
---|
| 1035 | EndDo |
---|
| 1036 | |
---|
| 1037 | a = invcoeffraf**2 |
---|
| 1038 | tabdiff3(1) = (1./3.)*a |
---|
| 1039 | a=2.*a |
---|
| 1040 | !CDIR ALTCODE |
---|
| 1041 | Do i=2,coeffraf |
---|
| 1042 | tabdiff3(i) = tabdiff3(i-1)+(real(i)-1)*a |
---|
| 1043 | EndDo |
---|
| 1044 | |
---|
| 1045 | !CDIR ALTCODE |
---|
| 1046 | Do i=1,coeffraf |
---|
| 1047 | tabppm(1,i,dir) = 0.08333333333333* |
---|
| 1048 | & (-1.+4*tabdiff2(i)-3*tabdiff3(i)) |
---|
| 1049 | tabppm(2,i,dir) = 0.08333333333333* |
---|
| 1050 | & (7.-26.*tabdiff2(i)+18.*tabdiff3(i)) |
---|
| 1051 | tabppm(3,i,dir) = 0.08333333333333* |
---|
| 1052 | & (7.+30*tabdiff2(i)-30*tabdiff3(i)) |
---|
| 1053 | tabppm(4,i,dir) = 0.08333333333333* |
---|
| 1054 | & (-1.-10.*tabdiff2(i)+18.*tabdiff3(i)) |
---|
| 1055 | tabppm(5,i,dir) = 0.08333333333333* |
---|
| 1056 | & (2*tabdiff2(i)-3*tabdiff3(i)) |
---|
| 1057 | End Do |
---|
| 1058 | C |
---|
| 1059 | C |
---|
| 1060 | diffmod = 0 |
---|
| 1061 | IF (mod(coeffraf,2) == 0) diffmod = 1 |
---|
| 1062 | C |
---|
| 1063 | ipos = i1 |
---|
| 1064 | C |
---|
| 1065 | Do iparent = locind_parent_left,locind_parent_last |
---|
| 1066 | pos=1 |
---|
| 1067 | !CDIR ALTCODE |
---|
| 1068 | Do jj = ipos - coeffraf/2+diffmod,ipos + coeffraf/2 |
---|
| 1069 | indparentppm_1d(jj) = iparent-2 |
---|
| 1070 | indchildppm_1d(jj) = pos |
---|
| 1071 | pos = pos+1 |
---|
| 1072 | End do |
---|
| 1073 | ipos = ipos + coeffraf |
---|
| 1074 | C |
---|
| 1075 | End do |
---|
| 1076 | |
---|
| 1077 | Do i=1,np2 |
---|
| 1078 | |
---|
| 1079 | indparentppm(1+(i-1)*nc:i*nc,dir) = |
---|
| 1080 | & indparentppm_1d(1:nc) + (i-1)*np |
---|
| 1081 | indchildppm (1+(i-1)*nc:i*nc,dir) = |
---|
| 1082 | & indchildppm_1d (1:nc) |
---|
| 1083 | |
---|
| 1084 | End do |
---|
| 1085 | |
---|
| 1086 | Return |
---|
| 1087 | End Subroutine ppm1dprecompute2d |
---|
| 1088 | |
---|
| 1089 | |
---|
| 1090 | Subroutine ppm1dprecompute(np,nc, |
---|
| 1091 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 1092 | C |
---|
| 1093 | CCC Description: |
---|
| 1094 | CCC Subroutine to compute coefficient and index for a 1D interpolation |
---|
| 1095 | CCC using piecewise parabolic method |
---|
| 1096 | CC Method: |
---|
| 1097 | C |
---|
| 1098 | C Declarations: |
---|
| 1099 | C |
---|
| 1100 | Implicit none |
---|
| 1101 | C |
---|
| 1102 | C Arguments |
---|
| 1103 | Integer :: np,nc |
---|
| 1104 | C Real, Dimension(:),Allocatable :: ytemp |
---|
| 1105 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 1106 | C |
---|
| 1107 | C Local scalars |
---|
| 1108 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 1109 | Integer :: iparent,ipos,pos,nmin,nmax |
---|
| 1110 | Real :: ypos |
---|
| 1111 | integer :: i1,jj |
---|
| 1112 | Real :: xpmin,a |
---|
| 1113 | C |
---|
| 1114 | Real :: xrmin,xrmax,am3,s2,s1 |
---|
| 1115 | Real, Dimension(np) :: xl,delta,a6,slope |
---|
| 1116 | C Real, Dimension(:),Allocatable :: diff,diff2,diff3 |
---|
| 1117 | INTEGER :: diffmod |
---|
| 1118 | REAL :: invcoeffraf |
---|
| 1119 | C |
---|
| 1120 | coeffraf = nint(ds_parent/ds_child) |
---|
| 1121 | C |
---|
| 1122 | If (coeffraf == 1) Then |
---|
| 1123 | return |
---|
| 1124 | End If |
---|
| 1125 | invcoeffraf = ds_child/ds_parent |
---|
| 1126 | C |
---|
| 1127 | |
---|
| 1128 | if (.not.allocated(indparentppm)) then |
---|
| 1129 | allocate(indparentppm(-2*coeffraf:nc+2*coeffraf,1), |
---|
| 1130 | & indchildppm(-2*coeffraf:nc+2*coeffraf,1)) |
---|
| 1131 | else |
---|
| 1132 | if (size(indparentppm,1)<nc+4*coeffraf+1) then |
---|
| 1133 | deallocate(indparentppm,indchildppm) |
---|
| 1134 | allocate(indparentppm(-2*coeffraf:nc+2*coeffraf,1), |
---|
| 1135 | & indchildppm(-2*coeffraf:nc+2*coeffraf,1)) |
---|
| 1136 | endif |
---|
| 1137 | endif |
---|
| 1138 | |
---|
| 1139 | ypos = s_child |
---|
| 1140 | C |
---|
| 1141 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 1142 | locind_parent_last = 1 + |
---|
| 1143 | & agrif_ceiling((ypos +(nc - 1) |
---|
| 1144 | & *ds_child - s_parent)/ds_parent) |
---|
| 1145 | C |
---|
| 1146 | xpmin = s_parent + (locind_parent_left-1)*ds_parent |
---|
| 1147 | i1 = 1+agrif_int((xpmin-s_child)/ds_child) |
---|
| 1148 | C |
---|
| 1149 | C |
---|
| 1150 | |
---|
| 1151 | Do i=1,coeffraf |
---|
| 1152 | tabdiff2(i)=(real(i)-0.5)*invcoeffraf |
---|
| 1153 | EndDo |
---|
| 1154 | |
---|
| 1155 | a = invcoeffraf**2 |
---|
| 1156 | tabdiff3(1) = (1./3.)*a |
---|
| 1157 | a=2.*a |
---|
| 1158 | !CDIR ALTCODE |
---|
| 1159 | !!!CDIR SHORTLOOP |
---|
| 1160 | Do i=2,coeffraf |
---|
| 1161 | tabdiff3(i) = tabdiff3(i-1)+(real(i)-1)*a |
---|
| 1162 | EndDo |
---|
| 1163 | |
---|
| 1164 | !CDIR ALTCODE |
---|
| 1165 | !!!CDIR SHORTLOOP |
---|
| 1166 | Do i=1,coeffraf |
---|
| 1167 | tabppm(1,i,1) = 0.08333333333333*(-1.+4*tabdiff2(i)-3*tabdiff3(i)) |
---|
| 1168 | tabppm(2,i,1) = 0.08333333333333* |
---|
| 1169 | & (7.-26.*tabdiff2(i)+18.*tabdiff3(i)) |
---|
| 1170 | tabppm(3,i,1) =0.08333333333333*(7.+30*tabdiff2(i)-30*tabdiff3(i)) |
---|
| 1171 | tabppm(4,i,1) = 0.08333333333333* |
---|
| 1172 | & (-1.-10.*tabdiff2(i)+18.*tabdiff3(i)) |
---|
| 1173 | tabppm(5,i,1) = 0.08333333333333*(2*tabdiff2(i)-3*tabdiff3(i)) |
---|
| 1174 | End Do |
---|
| 1175 | C |
---|
| 1176 | C |
---|
| 1177 | diffmod = 0 |
---|
| 1178 | IF (mod(coeffraf,2) == 0) diffmod = 1 |
---|
| 1179 | C |
---|
| 1180 | ipos = i1 |
---|
| 1181 | C |
---|
| 1182 | Do iparent = locind_parent_left,locind_parent_last |
---|
| 1183 | pos=1 |
---|
| 1184 | !CDIR ALTCODE |
---|
| 1185 | !CDIR SHORTLOOP |
---|
| 1186 | Do jj = ipos - coeffraf/2+diffmod,ipos + coeffraf/2 |
---|
| 1187 | indparentppm(jj,1) = iparent-2 |
---|
| 1188 | indchildppm(jj,1) = pos |
---|
| 1189 | pos = pos+1 |
---|
| 1190 | End do |
---|
| 1191 | ipos = ipos + coeffraf |
---|
| 1192 | C |
---|
| 1193 | End do |
---|
| 1194 | |
---|
| 1195 | Return |
---|
| 1196 | End Subroutine ppm1dprecompute |
---|
| 1197 | |
---|
| 1198 | Subroutine ppm1daftercompute(x,y,np,nc, |
---|
| 1199 | & s_parent,s_child,ds_parent,ds_child,dir) |
---|
| 1200 | C |
---|
| 1201 | CCC Description: |
---|
| 1202 | CCC Subroutine to do a 1D interpolation and apply monotonicity constraints |
---|
| 1203 | CCC using piecewise parabolic method |
---|
| 1204 | CCC on a child grid (vector y) from its parent grid (vector x). |
---|
| 1205 | CC Method: Use precomputed coefficient and index |
---|
| 1206 | C |
---|
| 1207 | C Declarations: |
---|
| 1208 | C |
---|
| 1209 | Implicit none |
---|
| 1210 | C |
---|
| 1211 | C Arguments |
---|
| 1212 | Integer :: np,nc,dir |
---|
| 1213 | Real, INTENT(IN),Dimension(np) :: x |
---|
| 1214 | Real, INTENT(OUT),Dimension(nc) :: y |
---|
| 1215 | C Real, Dimension(:),Allocatable :: ytemp |
---|
| 1216 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 1217 | C |
---|
| 1218 | C Local scalars |
---|
| 1219 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 1220 | Integer :: iparent,ipos,pos,nmin,nmax |
---|
| 1221 | Real :: ypos |
---|
| 1222 | integer :: i1,jj |
---|
| 1223 | Real :: xpmin,a |
---|
| 1224 | C |
---|
| 1225 | Real :: xrmin,xrmax,am3,s2,s1 |
---|
| 1226 | Real, Dimension(np) :: xl,delta,a6,slope |
---|
| 1227 | INTEGER :: diffmod |
---|
| 1228 | C |
---|
| 1229 | C |
---|
| 1230 | do i=1,nc |
---|
| 1231 | y(i)=tabppm(1,indchildppm(i,dir),dir)*x(indparentppm(i,dir))+ |
---|
| 1232 | & tabppm(2,indchildppm(i,dir),dir)*x(indparentppm(i,dir)+1)+ |
---|
| 1233 | & tabppm(3,indchildppm(i,dir),dir)*x(indparentppm(i,dir)+2)+ |
---|
| 1234 | & tabppm(4,indchildppm(i,dir),dir)*x(indparentppm(i,dir)+3)+ |
---|
| 1235 | & tabppm(5,indchildppm(i,dir),dir)*x(indparentppm(i,dir)+4) |
---|
| 1236 | enddo |
---|
| 1237 | |
---|
| 1238 | Return |
---|
| 1239 | End Subroutine ppm1daftercompute |
---|
| 1240 | |
---|
| 1241 | C ************************************************************************** |
---|
| 1242 | CCC Subroutine weno1d |
---|
| 1243 | C ************************************************************************** |
---|
| 1244 | C |
---|
| 1245 | Subroutine weno1dnew(x,y,np,nc, |
---|
| 1246 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 1247 | C |
---|
| 1248 | CCC Description: |
---|
| 1249 | CCC Subroutine to do a 1D interpolation and apply monotonicity constraints |
---|
| 1250 | CCC using piecewise parabolic method |
---|
| 1251 | CCC on a child grid (vector y) from its parent grid (vector x). |
---|
| 1252 | CC Method: |
---|
| 1253 | C |
---|
| 1254 | C Declarations: |
---|
| 1255 | C |
---|
| 1256 | Implicit none |
---|
| 1257 | C |
---|
| 1258 | C Arguments |
---|
| 1259 | Integer :: np,nc |
---|
| 1260 | Real, Dimension(np) :: x |
---|
| 1261 | Real, Dimension(nc) :: y |
---|
| 1262 | Real, Dimension(:),Allocatable :: ytemp |
---|
| 1263 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 1264 | C |
---|
| 1265 | C Local scalars |
---|
| 1266 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 1267 | Integer :: iparent,ipos,pos,nmin,nmax |
---|
| 1268 | Real :: ypos |
---|
| 1269 | integer :: i1,jj |
---|
| 1270 | Real :: xpmin,cavg,a,b |
---|
| 1271 | C |
---|
| 1272 | Real :: xrmin,xrmax,am3,s2,s1 |
---|
| 1273 | Real, Dimension(np) :: xr,xl,delta,a6,slope,slope2,smooth |
---|
| 1274 | Real, Dimension(:),Allocatable :: diff,diff2,diff3 |
---|
| 1275 | INTEGER :: diffmod |
---|
| 1276 | REAL :: invcoeffraf |
---|
| 1277 | integer :: s,l,k |
---|
| 1278 | integer :: etan, etap |
---|
| 1279 | real :: delta0, delta1, delta2 |
---|
| 1280 | real :: epsilon |
---|
| 1281 | parameter (epsilon = 1.D-8) |
---|
| 1282 | real, dimension(:,:), allocatable :: ak, ck |
---|
| 1283 | C |
---|
| 1284 | coeffraf = nint(ds_parent/ds_child) |
---|
| 1285 | C |
---|
| 1286 | If (coeffraf == 1) Then |
---|
| 1287 | locind_parent_left = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 1288 | y(1:nc) = x(locind_parent_left:locind_parent_left+nc-1) |
---|
| 1289 | return |
---|
| 1290 | End If |
---|
| 1291 | invcoeffraf = ds_child/ds_parent |
---|
| 1292 | Allocate(ak(0:1,coeffraf)) |
---|
| 1293 | Allocate(ck(0:1,coeffraf)) |
---|
| 1294 | |
---|
| 1295 | C |
---|
| 1296 | Allocate(ytemp(-2*coeffraf:nc+2*coeffraf)) |
---|
| 1297 | ypos = s_child |
---|
| 1298 | C |
---|
| 1299 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 1300 | locind_parent_last = 1 + |
---|
| 1301 | & agrif_ceiling((ypos +(nc - 1) |
---|
| 1302 | & *ds_child - s_parent)/ds_parent) |
---|
| 1303 | C |
---|
| 1304 | xpmin = s_parent + (locind_parent_left-1)*ds_parent |
---|
| 1305 | i1 = 1+agrif_int((xpmin-s_child)/ds_child) |
---|
| 1306 | C |
---|
| 1307 | Allocate( diff(coeffraf),diff2(coeffraf),diff3(coeffraf) ) |
---|
| 1308 | C |
---|
| 1309 | diff(1)=0.5*invcoeffraf |
---|
| 1310 | do i=2,coeffraf |
---|
| 1311 | diff(i) = diff(i-1)+invcoeffraf |
---|
| 1312 | enddo |
---|
| 1313 | |
---|
| 1314 | ak = 0. |
---|
| 1315 | ck = 0. |
---|
| 1316 | |
---|
| 1317 | do i=1,coeffraf |
---|
| 1318 | do k=0,1 |
---|
| 1319 | do s=0,2 |
---|
| 1320 | do l=0,2 |
---|
| 1321 | if (l /= s) then |
---|
| 1322 | ak(k,i) = ak(k,i)+(diff(i)-(k-l+1.)) |
---|
| 1323 | endif |
---|
| 1324 | enddo |
---|
| 1325 | enddo |
---|
| 1326 | enddo |
---|
| 1327 | |
---|
| 1328 | etap = 0 |
---|
| 1329 | etan = 0 |
---|
| 1330 | do k=0,1 |
---|
| 1331 | if (ak(k,i) > 0) then |
---|
| 1332 | etap = etap+1 |
---|
| 1333 | else if (ak(k,i) < 0) then |
---|
| 1334 | etan = etan + 1 |
---|
| 1335 | endif |
---|
| 1336 | enddo |
---|
| 1337 | |
---|
| 1338 | do k=0,1 |
---|
| 1339 | if (ak(k,i) == 0) then |
---|
| 1340 | Ck(k,i) = 1. |
---|
| 1341 | else if (ak(k,i) > 0) then |
---|
| 1342 | Ck(k,i) = 1./(etap * ak(k,i)) |
---|
| 1343 | else |
---|
| 1344 | Ck(k,i) = -1./(etan * ak(k,i)) |
---|
| 1345 | endif |
---|
| 1346 | enddo |
---|
| 1347 | enddo |
---|
| 1348 | |
---|
| 1349 | C |
---|
| 1350 | a = 0. |
---|
| 1351 | b = invcoeffraf |
---|
| 1352 | Do i=1,coeffraf |
---|
| 1353 | diff2(i) = 0.5*(b*b - a*a) |
---|
| 1354 | diff3(i) = (1./3.)*(b*b*b - a*a*a) |
---|
| 1355 | a = a + invcoeffraf |
---|
| 1356 | b = b + invcoeffraf |
---|
| 1357 | End do |
---|
| 1358 | C |
---|
| 1359 | if( locind_parent_last+2 <= np ) then |
---|
| 1360 | nmax = locind_parent_last+2 |
---|
| 1361 | elseif( locind_parent_last+1 <= np ) then |
---|
| 1362 | nmax = locind_parent_last+1 |
---|
| 1363 | else |
---|
| 1364 | nmax = locind_parent_last |
---|
| 1365 | endif |
---|
| 1366 | C |
---|
| 1367 | if(locind_parent_left-2 >= 1) then |
---|
| 1368 | nmin = locind_parent_left-2 |
---|
| 1369 | elseif(locind_parent_left-1 >= 1) then |
---|
| 1370 | nmin = locind_parent_left-1 |
---|
| 1371 | else |
---|
| 1372 | nmin = locind_parent_left |
---|
| 1373 | endif |
---|
| 1374 | C |
---|
| 1375 | Do i = nmin+1,nmax |
---|
| 1376 | slope(i) = (x(i) - x(i-1)) |
---|
| 1377 | Enddo |
---|
| 1378 | DO i=nmin+2,nmax |
---|
| 1379 | smooth(i) = 0.5*(slope(i)**2+slope(i-1)**2) |
---|
| 1380 | & +(slope(i)-slope(i-1))**2 |
---|
| 1381 | enddo |
---|
| 1382 | C |
---|
| 1383 | diffmod = 0 |
---|
| 1384 | IF (mod(coeffraf,2) == 0) diffmod = 1 |
---|
| 1385 | C |
---|
| 1386 | ipos = i1 |
---|
| 1387 | C |
---|
| 1388 | Do iparent = locind_parent_left,locind_parent_last |
---|
| 1389 | pos=1 |
---|
| 1390 | |
---|
| 1391 | delta0=1./(epsilon+smooth(iparent ))**3 |
---|
| 1392 | delta1=1./(epsilon+smooth(iparent+1))**3 |
---|
| 1393 | delta2=1./(epsilon+smooth(iparent+2))**3 |
---|
| 1394 | |
---|
| 1395 | Do jj = ipos - coeffraf/2+diffmod,ipos + coeffraf/2 |
---|
| 1396 | C |
---|
| 1397 | pos = pos+1 |
---|
| 1398 | End do |
---|
| 1399 | ipos = ipos + coeffraf |
---|
| 1400 | C |
---|
| 1401 | End do |
---|
| 1402 | C |
---|
| 1403 | C |
---|
| 1404 | y(1:nc)=ytemp(1:nc) |
---|
| 1405 | deallocate(ytemp) |
---|
| 1406 | deallocate(diff, diff2, diff3) |
---|
| 1407 | |
---|
| 1408 | deallocate(ak,ck) |
---|
| 1409 | |
---|
| 1410 | Return |
---|
| 1411 | End Subroutine weno1dnew |
---|
| 1412 | |
---|
| 1413 | C ************************************************************************** |
---|
| 1414 | CCC Subroutine weno1d |
---|
| 1415 | C ************************************************************************** |
---|
| 1416 | C |
---|
| 1417 | Subroutine weno1d(x,y,np,nc, |
---|
| 1418 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 1419 | C |
---|
| 1420 | CCC Description: |
---|
| 1421 | CCC Subroutine to do a 1D interpolation and apply monotonicity constraints |
---|
| 1422 | CCC using piecewise parabolic method |
---|
| 1423 | CCC on a child grid (vector y) from its parent grid (vector x). |
---|
| 1424 | CC Method: |
---|
| 1425 | C |
---|
| 1426 | C Declarations: |
---|
| 1427 | C |
---|
| 1428 | Implicit none |
---|
| 1429 | C |
---|
| 1430 | C Arguments |
---|
| 1431 | Integer :: np,nc |
---|
| 1432 | Real, Dimension(np) :: x |
---|
| 1433 | Real, Dimension(nc) :: y |
---|
| 1434 | Real, Dimension(:),Allocatable :: ytemp |
---|
| 1435 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 1436 | C |
---|
| 1437 | C Local scalars |
---|
| 1438 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 1439 | Integer :: iparent,ipos,pos,nmin,nmax |
---|
| 1440 | Real :: ypos |
---|
| 1441 | integer :: i1,jj |
---|
| 1442 | Real :: xpmin,cavg,a,b |
---|
| 1443 | C |
---|
| 1444 | Real :: xrmin,xrmax,am3,s2,s1 |
---|
| 1445 | Real, Dimension(np) :: xr,xl,delta,a6,slope,slope2 |
---|
| 1446 | Real, Dimension(:),Allocatable :: diff,diff2,diff3 |
---|
| 1447 | INTEGER :: diffmod |
---|
| 1448 | REAL :: invcoeffraf |
---|
| 1449 | integer :: s,l,k |
---|
| 1450 | integer :: etan, etap |
---|
| 1451 | real :: delta0, delta1,sumdelta |
---|
| 1452 | real :: epsilon |
---|
| 1453 | parameter (epsilon = 1.D-8) |
---|
| 1454 | C |
---|
| 1455 | coeffraf = nint(ds_parent/ds_child) |
---|
| 1456 | C |
---|
| 1457 | If (coeffraf == 1) Then |
---|
| 1458 | locind_parent_left = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 1459 | y(1:nc) = x(locind_parent_left:locind_parent_left+nc-1) |
---|
| 1460 | return |
---|
| 1461 | End If |
---|
| 1462 | invcoeffraf = ds_child/ds_parent |
---|
| 1463 | |
---|
| 1464 | C |
---|
| 1465 | Allocate(ytemp(-2*coeffraf:nc+2*coeffraf)) |
---|
| 1466 | ypos = s_child |
---|
| 1467 | C |
---|
| 1468 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 1469 | locind_parent_last = 1 + |
---|
| 1470 | & agrif_ceiling((ypos +(nc - 1) |
---|
| 1471 | & *ds_child - s_parent)/ds_parent) |
---|
| 1472 | C |
---|
| 1473 | xpmin = s_parent + (locind_parent_left-1)*ds_parent |
---|
| 1474 | i1 = 1+agrif_int((xpmin-s_child)/ds_child) |
---|
| 1475 | C |
---|
| 1476 | Allocate( diff(coeffraf)) |
---|
| 1477 | C |
---|
| 1478 | diff(1)=0.5*invcoeffraf |
---|
| 1479 | do i=2,coeffraf |
---|
| 1480 | diff(i) = diff(i-1)+invcoeffraf |
---|
| 1481 | enddo |
---|
| 1482 | C |
---|
| 1483 | if( locind_parent_last+2 <= np ) then |
---|
| 1484 | nmax = locind_parent_last+2 |
---|
| 1485 | else if( locind_parent_last+1 <= np ) then |
---|
| 1486 | nmax = locind_parent_last+1 |
---|
| 1487 | else |
---|
| 1488 | nmax = locind_parent_last |
---|
| 1489 | endif |
---|
| 1490 | C |
---|
| 1491 | if(locind_parent_left-1 >= 1) then |
---|
| 1492 | nmin = locind_parent_left-1 |
---|
| 1493 | else |
---|
| 1494 | nmin = locind_parent_left |
---|
| 1495 | endif |
---|
| 1496 | C |
---|
| 1497 | Do i = nmin+1,nmax |
---|
| 1498 | slope(i) = (x(i) - x(i-1)) |
---|
| 1499 | Enddo |
---|
| 1500 | C |
---|
| 1501 | diffmod = 0 |
---|
| 1502 | IF (mod(coeffraf,2) == 0) diffmod = 1 |
---|
| 1503 | C |
---|
| 1504 | ipos = i1 |
---|
| 1505 | C |
---|
| 1506 | Do iparent = locind_parent_left,locind_parent_last |
---|
| 1507 | pos=1 |
---|
| 1508 | delta0=1./(epsilon+slope(iparent )**2)**2 |
---|
| 1509 | delta1=1./(epsilon+slope(iparent+1)**2)**2 |
---|
| 1510 | sumdelta = 1./(delta0+delta1) |
---|
| 1511 | Do jj = ipos - coeffraf/2+diffmod,ipos + coeffraf/2 |
---|
| 1512 | C |
---|
| 1513 | ytemp(jj) = x(iparent)+(diff(pos)-0.5)*( |
---|
| 1514 | & delta0*slope(iparent)+ |
---|
| 1515 | & delta1*slope(iparent+1))*sumdelta |
---|
| 1516 | pos = pos+1 |
---|
| 1517 | End do |
---|
| 1518 | ipos = ipos + coeffraf |
---|
| 1519 | C |
---|
| 1520 | End do |
---|
| 1521 | C |
---|
| 1522 | C |
---|
| 1523 | y(1:nc)=ytemp(1:nc) |
---|
| 1524 | deallocate(ytemp) |
---|
| 1525 | deallocate(diff) |
---|
| 1526 | |
---|
| 1527 | Return |
---|
| 1528 | End Subroutine weno1d |
---|
| 1529 | |
---|
| 1530 | C |
---|
| 1531 | C ************************************************************************** |
---|
| 1532 | CCC Subroutine eno1d |
---|
| 1533 | C ************************************************************************** |
---|
| 1534 | C |
---|
| 1535 | Subroutine eno1d(x,y,np,nc, |
---|
| 1536 | & s_parent,s_child,ds_parent,ds_child) |
---|
| 1537 | C |
---|
| 1538 | CCC Description: |
---|
| 1539 | CCC ---- p 163-164 Computational gasdynamics ---- |
---|
| 1540 | CCC Subroutine to do a 1D interpolation |
---|
| 1541 | CCC using piecewise polynomial ENO reconstruction technique |
---|
| 1542 | CCC on a child grid (vector y) from its parent grid (vector x). |
---|
| 1543 | CC Method: |
---|
| 1544 | C |
---|
| 1545 | C Declarations: |
---|
| 1546 | C |
---|
| 1547 | Implicit none |
---|
| 1548 | C |
---|
| 1549 | C Arguments |
---|
| 1550 | Integer :: np,nc |
---|
| 1551 | Real, Dimension(np) :: x |
---|
| 1552 | Real, Dimension(nc) :: y |
---|
| 1553 | Real, Dimension(:),Allocatable :: ytemp |
---|
| 1554 | Real :: s_parent,s_child,ds_parent,ds_child |
---|
| 1555 | C |
---|
| 1556 | C Local scalars |
---|
| 1557 | Integer :: i,coeffraf,locind_parent_left,locind_parent_last |
---|
| 1558 | Integer :: ipos,pos |
---|
| 1559 | Real :: ypos,xi |
---|
| 1560 | integer :: i1,jj |
---|
| 1561 | Real :: xpmin,cavg |
---|
| 1562 | C |
---|
| 1563 | Real, Dimension(3,np) :: dd,c |
---|
| 1564 | Integer :: left |
---|
| 1565 | C |
---|
| 1566 | Real, DImension(1:np+1) :: xhalf |
---|
| 1567 | Real, Dimension(:,:),Allocatable :: Xbar |
---|
| 1568 | INTEGER :: diffmod |
---|
| 1569 | C |
---|
| 1570 | coeffraf = nint(ds_parent/ds_child) |
---|
| 1571 | C |
---|
| 1572 | If (coeffraf == 1) Then |
---|
| 1573 | locind_parent_left = 1 + nint((s_child - s_parent)/ds_parent) |
---|
| 1574 | y(1:nc) = x(locind_parent_left:locind_parent_left+nc-1) |
---|
| 1575 | return |
---|
| 1576 | End If |
---|
| 1577 | |
---|
| 1578 | diffmod = 0 |
---|
| 1579 | IF (mod(coeffraf,2) == 0) diffmod = 1 |
---|
| 1580 | C |
---|
| 1581 | Allocate(ytemp(-2*coeffraf:nc+2*coeffraf)) |
---|
| 1582 | ypos = s_child |
---|
| 1583 | locind_parent_left = 1 + agrif_int((ypos - s_parent)/ds_parent) |
---|
| 1584 | locind_parent_last = 1 + |
---|
| 1585 | & agrif_ceiling((ypos +(nc - 1) *ds_child - |
---|
| 1586 | & s_parent)/ds_parent) |
---|
| 1587 | xpmin = s_parent + (locind_parent_left-1)*ds_parent |
---|
| 1588 | i1 = 1+agrif_int((xpmin-s_child)/ds_child) |
---|
| 1589 | C |
---|
| 1590 | xhalf(np+1) = np + 0.5 |
---|
| 1591 | Do i = 1,np |
---|
| 1592 | xhalf(i) = i - 0.5 |
---|
| 1593 | Enddo |
---|
| 1594 | C |
---|
| 1595 | C compute divided differences |
---|
| 1596 | C |
---|
| 1597 | dd(1,1:np) = x(1:np) |
---|
| 1598 | dd(2,1:np-1) = 0.5*( dd(1,2:np) - dd(1,1:np-1) ) |
---|
| 1599 | dd(3,1:np-2) = (1./3.)*( dd(2,2:np-1) - dd(2,1:np-2) ) |
---|
| 1600 | C |
---|
| 1601 | Allocate( Xbar( coeffraf,2 ) ) |
---|
| 1602 | xi = 0.5 |
---|
| 1603 | Do i = 1,coeffraf |
---|
| 1604 | Xbar(i,1) = (i-1)*ds_child/ds_parent - xi |
---|
| 1605 | Xbar(i,2) = i*ds_child/ds_parent - xi |
---|
| 1606 | Enddo |
---|
| 1607 | C |
---|
| 1608 | ipos = i1 |
---|
| 1609 | C |
---|
| 1610 | DO i = locind_parent_left,locind_parent_last |
---|
| 1611 | left = i |
---|
| 1612 | do jj = 2,3 |
---|
| 1613 | If(abs(dd(jj,left)) .gt. abs(dd(jj,left-1))) |
---|
| 1614 | & left = left-1 |
---|
| 1615 | enddo |
---|
| 1616 | C |
---|
| 1617 | C convert to Taylor series form |
---|
| 1618 | C |
---|
| 1619 | Call Taylor(i,xhalf(left:left+2),dd(1:3,left),c(1:3,i)) |
---|
| 1620 | ENDDO |
---|
| 1621 | C |
---|
| 1622 | C evaluate the reconstruction on each cell |
---|
| 1623 | C |
---|
| 1624 | DO i = locind_parent_left,locind_parent_last |
---|
| 1625 | C |
---|
| 1626 | cavg = 0. |
---|
| 1627 | pos = 1. |
---|
| 1628 | C |
---|
| 1629 | Do jj = ipos - coeffraf/2+diffmod,ipos + coeffraf/2 |
---|
| 1630 | ytemp(jj) =(c(1,i)*(Xbar(pos,2)-Xbar(pos,1)) |
---|
| 1631 | & +c(2,i)*(Xbar(pos,2)*Xbar(pos,2)- |
---|
| 1632 | & Xbar(pos,1)*Xbar(pos,1)) |
---|
| 1633 | & +c(3,i)*(Xbar(pos,2)*Xbar(pos,2)*Xbar(pos,2)- |
---|
| 1634 | & Xbar(pos,1)*Xbar(pos,1)*Xbar(pos,1))) |
---|
| 1635 | & *coeffraf |
---|
| 1636 | cavg = cavg + ytemp(jj) |
---|
| 1637 | pos = pos+1 |
---|
| 1638 | Enddo |
---|
| 1639 | ipos = ipos + coeffraf |
---|
| 1640 | ENDDO |
---|
| 1641 | C |
---|
| 1642 | y(1:nc)=ytemp(1:nc) |
---|
| 1643 | deallocate(ytemp,Xbar) |
---|
| 1644 | C |
---|
| 1645 | Return |
---|
| 1646 | End Subroutine eno1d |
---|
| 1647 | C |
---|
| 1648 | C |
---|
| 1649 | C ************************************************************************** |
---|
| 1650 | CCC Subroutine taylor |
---|
| 1651 | C ************************************************************************** |
---|
| 1652 | C |
---|
| 1653 | subroutine taylor(ind,xhalf,dd,c) |
---|
| 1654 | C |
---|
| 1655 | Integer :: ind |
---|
| 1656 | real,dimension(3) :: dd,c |
---|
| 1657 | real,dimension(0:3,0:3) :: d |
---|
| 1658 | real,dimension(3) :: xhalf |
---|
| 1659 | integer ::i,j |
---|
| 1660 | C |
---|
| 1661 | C |
---|
| 1662 | d(0,0:3)=1. |
---|
| 1663 | do i = 1,3 |
---|
| 1664 | d(i,0)=(ind-xhalf(i))*d(i-1,0) |
---|
| 1665 | enddo |
---|
| 1666 | C |
---|
| 1667 | do i = 1,3 |
---|
| 1668 | do j = 1,3-i |
---|
| 1669 | d(i,j) = d(i,j-1) + (ind-xhalf(i+j))*d(i-1,j) |
---|
| 1670 | enddo |
---|
| 1671 | enddo |
---|
| 1672 | C |
---|
| 1673 | do j = 1,3 |
---|
| 1674 | c(j) = 0. |
---|
| 1675 | do i=0,3-j |
---|
| 1676 | c(j) = c(j) + d(i,j)*dd(i+j) |
---|
| 1677 | enddo |
---|
| 1678 | enddo |
---|
| 1679 | C |
---|
| 1680 | end subroutine taylor |
---|
| 1681 | |
---|
| 1682 | |
---|
| 1683 | REAL FUNCTION vanleer(tab) |
---|
| 1684 | REAL, DIMENSION(3) :: tab |
---|
| 1685 | real res1 |
---|
| 1686 | real p1,p2,p3 |
---|
| 1687 | |
---|
| 1688 | p1=(tab(3)-tab(1))/2. |
---|
| 1689 | p2=2.*(tab(2)-tab(1)) |
---|
| 1690 | p3=2.*(tab(3)-tab(2)) |
---|
| 1691 | |
---|
| 1692 | if ((p1>0.).AND.(p2>0.).AND.(p3>0)) then |
---|
| 1693 | res1=minval((/p1,p2,p3/)) |
---|
| 1694 | elseif ((p1<0.).AND.(p2<0.).AND.(p3<0)) then |
---|
| 1695 | res1=maxval((/p1,p2,p3/)) |
---|
| 1696 | else |
---|
| 1697 | res1=0. |
---|
| 1698 | endif |
---|
| 1699 | |
---|
| 1700 | vanleer = res1 |
---|
| 1701 | |
---|
| 1702 | |
---|
| 1703 | END FUNCTION vanleer |
---|
| 1704 | |
---|
| 1705 | C |
---|
| 1706 | End Module Agrif_Interpbasic |
---|