3 |
implicit none |
implicit none |
4 |
|
|
5 |
INTEGER, PARAMETER:: nmax = 30000 |
INTEGER, PARAMETER:: nmax = 30000 |
6 |
|
DOUBLE PRECISION abs_y |
7 |
|
|
8 |
|
private abs_y, funcd |
9 |
|
|
10 |
contains |
contains |
11 |
|
|
12 |
subroutine invert_zoom_x(xf, xtild, Xprimt, xlon, xprimm, xuv) |
subroutine invert_zoom_x(xf, xtild, G, xlon, xprim, xuv) |
13 |
|
|
14 |
use coefpoly_m, only: coefpoly |
use coefpoly_m, only: coefpoly, a1, a2, a3 |
15 |
USE dimens_m, ONLY: iim |
USE dimens_m, ONLY: iim |
16 |
use dynetat0_m, only: clon |
use dynetat0_m, only: clon |
17 |
use nr_util, only: pi_d, twopi_d |
use nr_util, only: pi_d, twopi_d |
18 |
|
use numer_rec_95, only: hunt, rtsafe |
19 |
|
|
20 |
|
DOUBLE PRECISION, intent(in):: Xf(0:), xtild(0:), G(0:) ! (0:nmax) |
21 |
|
|
22 |
DOUBLE PRECISION, intent(in):: Xf(0:), xtild(0:), Xprimt(0:) ! (0:2 * nmax) |
real, intent(out):: xlon(:), xprim(:) ! (iim) |
|
real, intent(out):: xlon(:), xprimm(:) ! (iim) |
|
23 |
|
|
24 |
DOUBLE PRECISION, intent(in):: xuv |
DOUBLE PRECISION, intent(in):: xuv |
25 |
|
! between - 0.25 and 0.5 |
26 |
! 0. si calcul aux points scalaires |
! 0. si calcul aux points scalaires |
27 |
! 0.5 si calcul aux points U |
! 0.5 si calcul aux points U |
28 |
|
|
29 |
! Local: |
! Local: |
30 |
DOUBLE PRECISION xo1, Xfi, a0, a1, a2, a3, Xf1, Xprimin |
DOUBLE PRECISION Y |
31 |
integer i, it, iter |
DOUBLE PRECISION h ! step of the uniform grid |
32 |
DOUBLE PRECISION, parameter:: my_eps = 1d-6 |
integer i, it |
33 |
|
|
34 |
DOUBLE PRECISION xxprim(iim), xvrai(iim) |
DOUBLE PRECISION xvrai(iim), Gvrai(iim) |
35 |
! intermediary variables because xlon and xprimm are simple precision |
! intermediary variables because xlon and xprim are simple precision |
36 |
|
|
37 |
!------------------------------------------------------------------ |
!------------------------------------------------------------------ |
38 |
|
|
39 |
DO i = 1, iim |
it = 0 ! initial guess |
40 |
Xfi = - pi_d + (i + xuv - 0.75d0) * twopi_d / iim |
h = twopi_d / iim |
|
|
|
|
it = 2 * nmax |
|
|
do while (xfi < xf(it) .and. it >= 1) |
|
|
it = it - 1 |
|
|
end do |
|
|
|
|
|
! Calcul de Xf(xvrai(i)) |
|
|
|
|
|
xvrai(i) = xtild(it) |
|
|
IF (it == 2 * nmax) it = 2 * nmax -1 |
|
|
CALL coefpoly(Xf(it), Xf(it + 1), Xprimt(it), Xprimt(it + 1), & |
|
|
xtild(it), xtild(it + 1), a0, a1, a2, a3) |
|
|
Xf1 = Xf(it) |
|
|
Xprimin = a1 + xvrai(i) * (2d0 * a2 + xvrai(i) * 3d0 * a3) |
|
|
xo1 = xvrai(i) |
|
|
iter = 1 |
|
|
|
|
|
do |
|
|
xvrai(i) = xvrai(i) - (Xf1 - Xfi) / Xprimin |
|
|
IF (ABS(xvrai(i) - xo1) <= my_eps .or. iter == 300) exit |
|
|
xo1 = xvrai(i) |
|
|
Xf1 = a0 + xvrai(i) * (a1 + xvrai(i) * (a2 + xvrai(i) * a3)) |
|
|
Xprimin = a1 + xvrai(i) * (2d0 * a2 + xvrai(i) * 3d0 * a3) |
|
|
end DO |
|
|
|
|
|
if (ABS(xvrai(i) - xo1) > my_eps) then |
|
|
! iter == 300 |
|
|
print *, 'Pas de solution.' |
|
|
print *, i, xfi |
|
|
STOP 1 |
|
|
end if |
|
41 |
|
|
42 |
xxprim(i) = twopi_d / (iim * Xprimin) |
DO i = 1, iim |
43 |
|
Y = - pi_d + (i + xuv - 0.75d0) * h |
44 |
|
! - pi <= y < pi |
45 |
|
abs_y = abs(y) |
46 |
|
|
47 |
|
call hunt(xf, abs_y, it, my_lbound = 0) |
48 |
|
! {0 <= it <= nmax - 1} |
49 |
|
|
50 |
|
! Calcul de xvrai(i) et Gvrai(i) |
51 |
|
CALL coefpoly(Xf(it), Xf(it + 1), G(it), G(it + 1), xtild(it), & |
52 |
|
xtild(it + 1)) |
53 |
|
xvrai(i) = rtsafe(funcd, xtild(it), xtild(it + 1), xacc = 1d-6) |
54 |
|
Gvrai(i) = a1 + xvrai(i) * (2d0 * a2 + xvrai(i) * 3d0 * a3) |
55 |
|
if (y < 0d0) xvrai(i) = - xvrai(i) |
56 |
end DO |
end DO |
57 |
|
|
58 |
DO i = 1, iim -1 |
DO i = 1, iim -1 |
63 |
END DO |
END DO |
64 |
|
|
65 |
xlon = xvrai + clon |
xlon = xvrai + clon |
66 |
xprimm = xxprim |
xprim = h / Gvrai |
67 |
|
|
68 |
end subroutine invert_zoom_x |
end subroutine invert_zoom_x |
69 |
|
|
70 |
|
!********************************************************************** |
71 |
|
|
72 |
|
SUBROUTINE funcd(x, fval, fderiv) |
73 |
|
|
74 |
|
use coefpoly_m, only: a0, a1, a2, a3 |
75 |
|
|
76 |
|
DOUBLE PRECISION, INTENT(IN):: x |
77 |
|
DOUBLE PRECISION, INTENT(OUT):: fval, fderiv |
78 |
|
|
79 |
|
fval = a0 + x * (a1 + x * (a2 + x * a3)) - abs_y |
80 |
|
fderiv = a1 + x * (2d0 * a2 + x * 3d0 * a3) |
81 |
|
|
82 |
|
END SUBROUTINE funcd |
83 |
|
|
84 |
end module invert_zoom_x_m |
end module invert_zoom_x_m |