--- trunk/dyn3d/fxhyp_loop_ik.f 2015/02/05 15:19:37 124 +++ trunk/Sources/dyn3d/invert_zoom_x.f 2015/06/18 12:23:44 149 @@ -1,92 +1,59 @@ -module fxhyp_loop_ik_m +module invert_zoom_x_m implicit none INTEGER, PARAMETER:: nmax = 30000 + DOUBLE PRECISION abs_y + + private abs_y, funcd contains - subroutine fxhyp_loop_ik(ik, decalx, xf, xtild, Xprimt, xzoom, xlon, & - xprimm, xuv) + subroutine invert_zoom_x(xf, xtild, G, xlon, xprim, xuv) - use coefpoly_m, only: coefpoly + use coefpoly_m, only: coefpoly, a1, a2, a3 USE dimens_m, ONLY: iim + use dynetat0_m, only: clon use nr_util, only: pi_d, twopi_d - use serre, only: grossismx + use numer_rec_95, only: hunt, rtsafe + + DOUBLE PRECISION, intent(in):: Xf(0:), xtild(0:), G(0:) ! (0:nmax) - INTEGER, intent(in):: ik - DOUBLE PRECISION, intent(in):: decalx - DOUBLE PRECISION, intent(in):: Xf(0:), xtild(0:), Xprimt(0:) ! (0:2 * nmax) - DOUBLE PRECISION, intent(in):: xzoom - real, intent(out):: xlon(:), xprimm(:) ! (iim) + real, intent(out):: xlon(:), xprim(:) ! (iim) DOUBLE PRECISION, intent(in):: xuv + ! between - 0.25 and 0.5 ! 0. si calcul aux points scalaires - ! 0.5 si calcul aux points U + ! 0.5 si calcul aux points U ! Local: - DOUBLE PRECISION xo1, Xfi, xi, a0, a1, a2, a3, Xf1, Xprimin - integer ii1, ii2, i, it, iter - DOUBLE PRECISION, parameter:: my_eps = 1e-6 - DOUBLE PRECISION xxprim(iim + 1), xvrai(iim + 1) - - !------------------------------------------------------------------ - - IF (ik == 1 .and. grossismx == 1.) THEN - ii1 = 2 - ii2 = iim + 1 - 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 + DOUBLE PRECISION Y + integer i, it - ! Calcul de Xf(xi) + real xvrai(iim), Gvrai(iim) + ! intermediary variables because xlon and xprim are simple precision - xi = xtild(it) + !------------------------------------------------------------------ - IF (it == 2 * nmax) THEN - it = 2 * nmax -1 - END IF + it = 0 ! initial guess - 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 + xi * (2d0 * a2 + xi * 3d0 * a3) - xo1 = xi - iter = 1 - - do - xi = xi - (Xf1 - Xfi) / Xprimin - IF (ABS(xi - xo1) <= my_eps .or. iter == 300) exit - xo1 = xi - Xf1 = a0 + xi * (a1 + xi * (a2 + xi * a3)) - Xprimin = a1 + xi * (2d0 * a2 + xi * 3d0 * a3) - end DO - - if (ABS(xi - xo1) > my_eps) then - ! iter == 300 - print *, 'Pas de solution.' - print *, i, xfi - STOP 1 - end if - - xxprim(i) = twopi_d / (REAL(iim) * Xprimin) - xvrai(i) = xi + xzoom + DO i = 1, iim + Y = - pi_d + (i + xuv - 0.75d0) * twopi_d / iim + ! - pi <= y < pi + abs_y = abs(y) + + call hunt(xf, abs_y, it, my_lbound = 0) + ! {0 <= it <= nmax - 1} + + ! Calcul de xvrai(i) et Gvrai(i) + CALL coefpoly(Xf(it), Xf(it + 1), G(it), G(it + 1), xtild(it), & + xtild(it + 1)) + xvrai(i) = rtsafe(funcd, real(xtild(it)), real(xtild(it + 1)), & + xacc = 1e-6) + Gvrai(i) = a1 + xvrai(i) * (2d0 * a2 + xvrai(i) * 3d0 * a3) + if (y < 0d0) xvrai(i) = - xvrai(i) end DO - 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 -1 IF (xvrai(i + 1) < xvrai(i)) THEN print *, 'xvrai(', i + 1, ') < xvrai(', i, ')' @@ -94,11 +61,23 @@ END IF END DO - DO i = 1, iim - xlon(i) = xvrai(i) - xprimm(i) = xxprim(i) - END DO + xlon = xvrai + clon + xprim = twopi_d / (iim * Gvrai) + + end subroutine invert_zoom_x + + !********************************************************************** + + SUBROUTINE funcd(x, fval, fderiv) + + use coefpoly_m, only: a0, a1, a2, a3 + + REAL, INTENT(IN):: x + REAL, INTENT(OUT):: fval, fderiv + + fval = a0 + x * (a1 + x * (a2 + x * a3)) - abs_y + fderiv = a1 + x * (2. * a2 + x * 3. * a3) - end subroutine fxhyp_loop_ik + END SUBROUTINE funcd -end module fxhyp_loop_ik_m +end module invert_zoom_x_m