322
324
325
326
327#include "implicit_f.inc"
328
329
330
331#include "com01_c.inc"
332#include "units_c.inc"
333
334
335
336 TYPE(TTABLE) :: TABLE
337 INTEGER ,INTENT(IN) :: NEL
338 INTEGER ,VALUE ,INTENT(IN) :: DIMX
339 INTEGER ,DIMENSION(DIMX,TABLE%NDIM) :: IPOS
340 my_real ,
DIMENSION(DIMX,TABLE%NDIM) :: xx
341 my_real ,
DIMENSION(NEL) :: yy, dydx1
342
343
344
345 LOGICAL, DIMENSION(NEL) :: NEED_TO_COMPUTE
346 INTEGER NDIM, K, NXK(4), I, IB(NEL,2,2,2,2),
347 . IP,IN,IM,IL,P,N,M,L,N1,N12,N123
348 my_real :: dx2,r(nel,4),unr(nel,4),dx2_0(nel)
349 INTEGER :: J
350 INTEGER :: NINDX_1,M_INDX1,NINDX_2,M_INDX2
351 INTEGER, DIMENSION(NEL) :: INDX_1,INDX_2
352
353 r(1:nel,1:4) = zero
354 ndim=table%NDIM
355 IF (SIZE(xx,2) < table%NDIM) THEN
356 WRITE(iout,*) ' ** INTERNAL ERROR - TABLE INTERPOLATION'
357 WRITE(istdo,*)' ** INTERNAL ERROR - TABLE INTERPOLATION'
359 END IF
360
361 DO k=1,ndim
362 nxk(k)=SIZE(table%X(k)%VALUES)
363 ENDDO
364
365 DO k=1,ndim
366 ipos(1:nel,k)=
max(ipos(1:nel,k),1)
367 nindx_1 = 0
368 m_indx1 = 0
369 nindx_2 = 0
370 m_indx2 = nxk(k) + 1
371#include "vectorize.inc"
372 DO i=1,nel
373 m = ipos(i,k)
374 dx2_0(i) = table%X(k)%VALUES(m) - xx(i,k)
375 IF(dx2_0(i) >= zero)THEN
376 nindx_1 = nindx_1 + 1
377 indx_1(nindx_1) = i
378 m_indx1 =
max(m_indx1,m)
379 ELSE
380 nindx_2 = nindx_2 + 1
381 indx_2(nindx_2) = i
382 m_indx2 =
min(m_indx2,m)
383 ENDIF
384 ENDDO
385
386 need_to_compute(1:nindx_1) = .true.
387 DO n=m_indx1,1,-1
388#include "vectorize.inc"
389 DO j=1,nindx_1
390 IF(need_to_compute(j)) THEN
391 i = indx_1(j)
392 m = ipos(i,k)
393 dx2 = table%X(k)%VALUES(n) - xx(i,k)
394 IF(dx2<zero.OR.n <=1)THEN
396 need_to_compute(j) = .false.
397 ENDIF
398 ENDIF
399 ENDDO
400 ENDDO
401 need_to_compute(1:nindx_2) = .true.
402 DO n=m_indx2,nxk(k)
403#include "vectorize.inc"
404 DO j=1,nindx_2
405 IF(need_to_compute(j)) THEN
406 i = indx_2(j)
407 m = ipos(i,k)
408 dx2 = table%X(k)%VALUES(n) - xx(i,k)
409 IF(dx2>=zero.OR.n==nxk(k))THEN
410 ipos(i,k)=n-1
411 need_to_compute(j) = .false.
412 ENDIF
413 ENDIF
414 ENDDO
415 ENDDO
416 ENDDO
417
418 DO k=1,ndim
419#include "vectorize.inc"
420 DO i=1,nel
421 n = ipos(i,k)
422 r(i,k) =(table%X(k)%VALUES(n+1)-xx(i,k))/
423 . (table%X(k)%VALUES(n+1)-table%X(k)%VALUES(n))
424 END DO
425 END DO
426
427 SELECT CASE(ndim)
428
429 CASE(4)
430
431 n1 =nxk(1)
432 n12 =nxk(1)*nxk(2)
433 n123=n12 *nxk(3)
434 DO i=1,nel
435 DO p=0,1
436 ip=n123*(ipos(i,4)-1+p)
437 DO n=0,1
438 in=n12*(ipos(i,3)-1+n)
439 DO m=0,1
440 im=n1*(ipos(i,2)-1+m)
441 DO l=0,1
442 il=ipos(i,1)+l
443 ib(i,l+1,m+1,n+1,p+1)=ip+in+im+il
444 END DO
445 END DO
446 END DO
447 END DO
448 END DO
449
450 unr(1:nel,1:4)=one-r(1:nel,1:4)
451#include "vectorize.inc"
452 DO i=1,nel
453
454 yy(i)=
455 . r(i,4)*(r(i,3)*(r(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,1,1,1))
456 . +unr(i,1)*table%Y%VALUES(ib(i,2,1,1,1)))
457 . +unr(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,2,1,1))
458 . +unr(i,1)*table%Y%VALUES(ib(i,2,2,1,1))))
459 . +unr(i,3)*(r(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,1,2,1))
460 . +unr(i,1)*table%Y%VALUES(ib(i,2,1,2,1)))
461 . +unr(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,2,2,1))
462 . +unr(i,1)*table%Y%VALUES(ib(i,2,2,2,1)))))
463 . +unr(i,4)*(r(i,3)*(r(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,1,1,1))
464 . +unr(i,1)*table%Y%VALUES(ib(i,2,1,1,1)))
465 . +unr(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,2,1,1))
466 . +unr(i,1)*table%Y%VALUES(ib(i,2,2,1,1))))
467 . +unr(i,3)*(r(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,1,2,1))
468 . +unr(i,1)*table%Y%VALUES(ib(i,2,1,2,1)))
469 . +unr(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,2,2,1))
470 . +unr(i,1)*table%Y%VALUES(ib(i,2,2,2,1)))))
471
472 dydx1(i)=
473 . (r(i,4)*(r(i,3)*(r(i,2)*( table%Y%VALUES(ib(i,2,1,1,1))
474 . -table%Y%VALUES(ib(i,1,1,1,1)))
475 . +unr(i,2)*( table%Y%VALUES(ib(i,2,2,1,1))
476 . -table%Y%VALUES(ib(i,1,2,1,1))))
477 . +unr(i,3)*(r(i,2)*( table%Y%VALUES(ib(i,2,1,2,1))
478 . -table%Y%VALUES(ib(i,1,1,2,1)))
479 . +unr(i,2)*( table%Y%VALUES(ib(i,2,2,2,1))
480 . -table%Y%VALUES(ib(i,1,2,2,1)))))
481 . +unr(i,4)*(r(i,3)*(r(i,2)*( table%Y%VALUES(ib(i,2,1,1,1))
482 . -table%Y%VALUES(ib(i,1,1,1,1)))
483 . +unr(i,2)*( table%Y%VALUES(ib(i,2,2,1,1))
484 . -table%Y%VALUES(ib(i,1,2,1,1))))
485 . +unr(i,3)*(r(i,2)*( table%Y%VALUES(ib(i,2,1,2,1))
486 . -table%Y%VALUES(ib(i,1,1,2,1)))
487 . +unr(i,2)*( table%Y%VALUES(ib(i,2,2,2,1))
488 . -table%Y%VALUES(ib(i,1,2,2,1))))))/
489 . (table%X(1)%VALUES(ipos(i,1)+1)-table%X(1)%VALUES(ipos(i,1)))
490
491 END DO
492
493 CASE(3)
494
495 n1 =nxk(1)
496 n12 =nxk(1)*nxk(2)
497 DO i=1,nel
498 DO n=0,1
499 in=n12*(ipos(i,3)-1+n)
500 DO m=0,1
501 im=n1*(ipos(i,2)-1+m)
502 DO l=0,1
503 il=ipos(i,1)+l
504 ib(i,l+1,m+1,n+1,1)=in+im+il
505 END DO
506 END DO
507 END DO
508 END DO
509
510 unr(1:nel,1:3)=one-r(1:nel,1:3)
511#include "vectorize.inc"
512 DO i=1,nel
513
514 yy(i)=
515 . (r(i,3)*(r(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,1,1,1))
516 . +unr(i,1)*table%Y%VALUES(ib(i,2,1,1,1)))
517 . +unr(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,2,1,1))
518 . +unr(i,1)*table%Y%VALUES(ib(i,2,2,1,1))))
519 . +unr(i,3)*(r(i,2)*(r(i,1)*table%Y%VALUES(ib(i
520 . +unr(i,1)*table%Y%VALUES(ib(i,2,1,2,1)))
521 . +unr(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,2,2,1))
522 . +unr(i,1)*table%Y%VALUES(ib(i,2,2,2,1)))))
523
524 dydx1(i)=
525 . (r(i,3)*(r(i,2)*( table%Y%VALUES(ib(i,2,1,1,1))
526 . -table%Y%VALUES(ib(i,1,1,1,1)))
527 . +unr(i,2)*( table%Y%VALUES(ib(i,2,2,1,1))
528 . -table%Y%VALUES(ib(i,1,2,1,1))))
529 . +unr(i,3)*(r(i,2)*( table%Y%VALUES(ib(i,2,1,2,1))
530 . -table%Y%VALUES(ib(i,1,1,2,1)))
531 . +unr(i,2)*( table%Y%VALUES(ib(i,2,2,2,1))
532 . -table%Y%VALUES(ib(i,1,2,2,1)))))/
533 . (table%X(1)%VALUES(ipos(i,1)+1)-table%X(1)%VALUES(ipos(i,1)))
534
535 END DO
536
537 CASE(2)
538
539 n1 =nxk(1)
540 DO i=1,nel
541 DO m=0,1
542 im=n1*(ipos(i,2)-1+m)
543 DO l=0,1
544 il=ipos(i,1)+l
545 ib(i,l+1,m+1,1,1)=im+il
546 END DO
547 END DO
548 END DO
549
550 unr(1:nel,1:2)=one-r(1:nel,1:2)
551#include "vectorize.inc"
552 DO i=1,nel
553
554 yy(i)=
555 . (r(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,1,1,1))
556 . +unr(i,1)*table%Y%VALUES(ib(i,2,1,1,1)))
557 . +unr(i,2)*(r(i,1)*table%Y%VALUES(ib(i,1,2,1,1))
558 . +unr(i,1)*table%Y%VALUES(ib(i,2,2,1,1))))
559 dydx1(i)=
560 . (r(i,2)*( table%Y%VALUES(ib(i,2,1,1,1))
561 . -table%Y%VALUES(ib(i,1,1,1,1)))
562 . +unr(i,2)*( table%Y%VALUES(ib(i,2,2,1,1))
563 . -table%Y%VALUES(ib(i,1,2,1,1))))/
564 . (table%X(1)%VALUES(ipos(i,1)+1)-table%X(1)%VALUES(ipos(i,1)))
565 END DO
566
567 CASE(1)
568
569 unr(1:nel,1:1)=one-r(1:nel,1:1)
570#include "vectorize.inc"
571 DO i=1,nel
572
573 yy(i)= r(i,1)*table%Y%VALUES(ipos(i,1))
574 . +unr(i,1)*table%Y%VALUES(ipos(i,1)+1)
575 dydx1(i)=(table%Y%VALUES(ipos(i,1)+1)-table%Y%VALUES(ipos(i,1)))/
576 . (table%X(1)%VALUES(ipos(i,1)+1)-table%X(1)%VALUES(ipos(i,1)))
577 END DO
578
579 END SELECT
580
581 RETURN