1 |
module fxhyp_loop_ik_m |
module invert_zoom_x_m |
2 |
|
|
3 |
implicit none |
implicit none |
4 |
|
|
6 |
|
|
7 |
contains |
contains |
8 |
|
|
9 |
subroutine fxhyp_loop_ik(ik, decalx, xf, xtild, Xprimt, xzoom, xlon, & |
subroutine invert_zoom_x(xf, xtild, Xprimt, xlon, xprimm, xuv) |
|
xprimm, xuv) |
|
10 |
|
|
11 |
use coefpoly_m, only: coefpoly |
use coefpoly_m, only: coefpoly |
12 |
USE dimens_m, ONLY: iim |
USE dimens_m, ONLY: iim |
13 |
use nr_util, only: pi_d, twopi_d, twopi |
use dynetat0_m, only: clon |
14 |
use serre, only: grossismx |
use nr_util, only: pi_d, twopi_d |
15 |
|
use numer_rec_95, only: hunt |
16 |
|
|
|
INTEGER, intent(in):: ik |
|
|
DOUBLE PRECISION, intent(in):: decalx |
|
17 |
DOUBLE PRECISION, intent(in):: Xf(0:), xtild(0:), Xprimt(0:) ! (0:2 * nmax) |
DOUBLE PRECISION, intent(in):: Xf(0:), xtild(0:), Xprimt(0:) ! (0:2 * nmax) |
18 |
DOUBLE PRECISION, intent(in):: xzoom |
real, intent(out):: xlon(:), xprimm(:) ! (iim) |
|
real, intent(out):: xlon(:), xprimm(:) ! (iim + 1) |
|
19 |
|
|
20 |
DOUBLE PRECISION, intent(in):: xuv |
DOUBLE PRECISION, intent(in):: xuv |
21 |
|
! between - 0.25 and 0.5 |
22 |
! 0. si calcul aux points scalaires |
! 0. si calcul aux points scalaires |
23 |
! 0.5 si calcul aux points U |
! 0.5 si calcul aux points U |
24 |
|
|
25 |
! Local: |
! Local: |
26 |
|
DOUBLE PRECISION xo1, Xfi, a0, a1, a2, a3, Xf1, Xprimin |
27 |
|
integer i, it, iter |
28 |
|
DOUBLE PRECISION, parameter:: my_eps = 1d-6 |
29 |
|
|
30 |
DOUBLE PRECISION xo1, Xfi, xi, a0, a1, a2, a3, Xf1, Xprimin, xi2 |
DOUBLE PRECISION xxprim(iim), xvrai(iim) |
31 |
integer ii1, ii2, i, it, iter, idif, ii |
! intermediary variables because xlon and xprimm are simple precision |
|
DOUBLE PRECISION, parameter:: my_eps = 1e-3 |
|
|
DOUBLE PRECISION xxprim(iim + 1), xvrai(iim + 1) |
|
|
INTEGER:: is2 = 0 |
|
32 |
|
|
33 |
!------------------------------------------------------------------ |
!------------------------------------------------------------------ |
34 |
|
|
35 |
xo1 = 0. |
it = 0 ! initial guess |
36 |
|
|
37 |
IF (ik == 1 .and. grossismx == 1.) THEN |
DO i = 1, iim |
38 |
ii1 = 2 |
Xfi = - pi_d + (i + xuv - 0.75d0) * twopi_d / iim |
39 |
ii2 = iim + 1 |
! - pi <= xfi < pi |
|
else |
|
|
ii1=1 |
|
|
ii2=iim |
|
|
END IF |
|
|
|
|
|
DO i = ii1, ii2 |
|
|
Xfi = - pi_d + (i + xuv - decalx) * twopi_d / iim |
|
|
|
|
|
it = 2 * nmax |
|
|
do while (xfi < xf(it) .and. it >= 1) |
|
|
it = it - 1 |
|
|
end do |
|
|
|
|
|
! Calcul de Xf(xi) |
|
|
|
|
|
xi = xtild(it) |
|
40 |
|
|
41 |
IF (it == 2 * nmax) THEN |
call hunt(xf, xfi, it, my_lbound = 0) |
42 |
it = 2 * nmax -1 |
it = max(0, it) |
43 |
END IF |
! In principle, xfi >= xf(0), max with 0 just in case of |
44 |
|
! roundoff error. {0 <= it <= 2 * nmax - 1} |
45 |
|
|
46 |
! Appel de la routine qui calcule les coefficients a0, a1, |
! Calcul de Xf(xvrai(i)) |
|
! a2, a3 d'un polynome de degre 3 qui passe par les points |
|
|
! (Xf(it), xtild(it)) et (Xf(it + 1), xtild(it + 1)) |
|
47 |
|
|
48 |
CALL coefpoly(Xf(it), Xf(it + 1), Xprimt(it), Xprimt(it + 1), & |
CALL coefpoly(Xf(it), Xf(it + 1), Xprimt(it), Xprimt(it + 1), & |
49 |
xtild(it), xtild(it + 1), a0, a1, a2, a3) |
xtild(it), xtild(it + 1), a0, a1, a2, a3) |
50 |
|
xvrai(i) = xtild(it) |
51 |
Xf1 = Xf(it) |
Xf1 = Xf(it) |
52 |
Xprimin = a1 + 2. * a2 * xi + 3. * a3 * xi**2 |
Xprimin = a1 + xvrai(i) * (2d0 * a2 + xvrai(i) * 3d0 * a3) |
53 |
|
xo1 = xvrai(i) |
54 |
iter = 1 |
iter = 1 |
55 |
|
|
56 |
do |
do |
57 |
xi = xi - (Xf1 - Xfi) / Xprimin |
xvrai(i) = xvrai(i) - (Xf1 - Xfi) / Xprimin |
58 |
IF (ABS(xi - xo1) <= my_eps .or. iter == 300) exit |
IF (ABS(xvrai(i) - xo1) <= my_eps .or. iter == 300) exit |
59 |
xo1 = xi |
xo1 = xvrai(i) |
60 |
xi2 = xi * xi |
Xf1 = a0 + xvrai(i) * (a1 + xvrai(i) * (a2 + xvrai(i) * a3)) |
61 |
Xf1 = a0 + a1 * xi + a2 * xi2 + a3 * xi2 * xi |
Xprimin = a1 + xvrai(i) * (2d0 * a2 + xvrai(i) * 3d0 * a3) |
|
Xprimin = a1 + 2. * a2 * xi + 3. * a3 * xi2 |
|
62 |
end DO |
end DO |
63 |
|
|
64 |
if (ABS(xi - xo1) > my_eps) then |
if (ABS(xvrai(i) - xo1) > my_eps) then |
65 |
! iter == 300 |
! iter == 300 |
66 |
print *, 'Pas de solution.' |
print *, 'Pas de solution.' |
67 |
print *, i, xfi |
print *, i, xfi |
68 |
STOP 1 |
STOP 1 |
69 |
end if |
end if |
70 |
|
|
71 |
xxprim(i) = twopi_d / (REAL(iim) * Xprimin) |
xxprim(i) = twopi_d / (iim * Xprimin) |
|
xvrai(i) = xi + xzoom |
|
72 |
end DO |
end DO |
73 |
|
|
|
IF (ik == 1 .and. grossismx == 1.) THEN |
|
|
xvrai(1) = xvrai(iim + 1)-twopi_d |
|
|
xxprim(1) = xxprim(iim + 1) |
|
|
END IF |
|
|
|
|
|
DO i = 1, iim |
|
|
xlon(i) = xvrai(i) |
|
|
xprimm(i) = xxprim(i) |
|
|
END DO |
|
|
|
|
74 |
DO i = 1, iim -1 |
DO i = 1, iim -1 |
75 |
IF (xvrai(i + 1) < xvrai(i)) THEN |
IF (xvrai(i + 1) < xvrai(i)) THEN |
76 |
print *, 'rlonu(', i + 1, ') < rlonu(', i, ')' |
print *, 'xvrai(', i + 1, ') < xvrai(', i, ')' |
77 |
STOP 1 |
STOP 1 |
78 |
END IF |
END IF |
79 |
END DO |
END DO |
80 |
|
|
81 |
IF (.not. (MINval(xvrai(:iim)) >= - pi_d - 1d-5 & |
xlon = xvrai + clon |
82 |
.and. MAXval(xvrai(:iim)) <= pi_d + 1d-5)) THEN |
xprimm = xxprim |
|
IF (xzoom <= 0.) THEN |
|
|
IF (ik == 1) THEN |
|
|
i = 1 |
|
|
|
|
|
do while (xvrai(i) < - pi_d .and. i < iim) |
|
|
i = i + 1 |
|
|
end do |
|
|
|
|
|
if (xvrai(i) < - pi_d) then |
|
|
print *, 'Xvrai plus petit que - pi !' |
|
|
STOP 1 |
|
|
end if |
|
|
|
|
|
is2 = i |
|
|
END IF |
|
|
|
|
|
IF (is2 /= 1) THEN |
|
|
DO ii = is2, iim |
|
|
xlon(ii-is2 + 1) = xvrai(ii) |
|
|
xprimm(ii-is2 + 1) = xxprim(ii) |
|
|
END DO |
|
|
DO ii = 1, is2 -1 |
|
|
xlon(ii + iim-is2 + 1) = xvrai(ii) + twopi_d |
|
|
xprimm(ii + iim-is2 + 1) = xxprim(ii) |
|
|
END DO |
|
|
END IF |
|
|
ELSE |
|
|
IF (ik == 1) THEN |
|
|
i = iim |
|
|
|
|
|
do while (xvrai(i) > pi_d .and. i > 1) |
|
|
i = i - 1 |
|
|
end do |
|
|
|
|
|
if (xvrai(i) > pi_d) then |
|
|
print *, 'Xvrai plus grand que pi !' |
|
|
STOP 1 |
|
|
end if |
|
|
|
|
|
is2 = i |
|
|
END IF |
|
|
|
|
|
idif = iim -is2 |
|
|
|
|
|
DO ii = 1, is2 |
|
|
xlon(ii + idif) = xvrai(ii) |
|
|
xprimm(ii + idif) = xxprim(ii) |
|
|
END DO |
|
|
|
|
|
DO ii = 1, idif |
|
|
xlon(ii) = xvrai(ii + is2) - twopi_d |
|
|
xprimm(ii) = xxprim(ii + is2) |
|
|
END DO |
|
|
END IF |
|
|
END IF |
|
|
|
|
|
xlon(iim + 1) = xlon(1) + twopi |
|
|
xprimm(iim + 1) = xprimm(1) |
|
83 |
|
|
84 |
end subroutine fxhyp_loop_ik |
end subroutine invert_zoom_x |
85 |
|
|
86 |
end module fxhyp_loop_ik_m |
end module invert_zoom_x_m |