37
38
39
40 USE python_funct_mod, ONLY : python_
41 use finter_mixed_mod, only : finter_mixed
42 USE sensor_mod
43
44
45
46#include "implicit_f.inc"
47#include "comlock.inc"
48
49
50
51#include "com04_c.inc"
52
53#include "com08_c.inc"
54#include "task_c.inc"
55#include "param_c.inc"
56
57
58
59 INTEGER NPC(*),NDDIM,NVDIM,NSENSOR
60 INTEGER IGRV(NIGRV,*),IB(*)
61 INTEGER WEIGHT(*), ITASK, TAGSLV_RBY_SMS(*)
63 . agrv(lfacgrv,*), tf(*), a(3,*), v(3,*), ms(*),
64 . x(3,*), skew(lskew,*)
65 TYPE (SENSOR_STR_) ,DIMENSION(NSENSOR) ,INTENT(IN) :: SENSOR_TAB
66 DOUBLE PRECISION,INTENT(INOUT) :: WFEXT
67 TYPE(python_), intent(inout) :: python
68
69
70
71 INTEGER NL, N1, ISK, N2, IFUNC, K1, K2, K3, ISENS,K,NN,IAD,J, IADF, IADL
72 my_real nx, ny, nz, axi, a0, aa, vv, fx, fy, fz, ax, ts,gama, wfextt,fcx,fcy
74
75 wfextt=zero
76
85 iadf = iad+itask*nn/nthread
86 iadl = iad-1+(itask+1)*nn/nthread
87
88 isens=0
89 DO k=1,nsensor
90 IF(igrv(6,
nl)== sensor_tab(k)%SENS_ID) isens=k
91 ENDDO
92 IF(isens==0)THEN
93 ts=tt
94 ELSE
95 ts = tt-sensor_tab(isens)%TSTART
96 IF(ts<0.0)cycle
97 ENDIF
98
99 IF (ifunc > 0) THEN
100 a0 = fcy*finter_mixed(python,nfunct,ifunc,(ts-dt1)*fcx,npc,tf)
101 gama = fcy*finter_mixed(python,nfunct,ifunc,ts*fcx,npc,tf)
102 ELSE
103 a0 = fcy
104 gama = fcy
105 ENDIF
106
107 aa = gama
108 IF(isk<=1)THEN
109#include "vectorize.inc"
110 DO j=iadf,iadl
111 n1=iabs(ib(j))
112 IF(tagslv_rby_sms(n1)/=0) cycle
113 a(n2,n1)=a(n2,n1)+ms(n1)*aa
114 IF(ib(j)>0) wfextt=wfextt + half*(a0+aa)*ms(n1)*v(n2,n1)*dt1*weight(n1)
115 ENDDO
116 ELSE
117 k1=3*n2-2
118 k2=3*n2-1
119 k3=3*n2
120#include "vectorize.inc"
121 DO j=iadf,iadl
122 n1=iabs(ib(j))
123 IF(tagslv_rby_sms(n1)/=0) cycle
124 vv = skew(k1,isk)*v(1,n1)+skew(k2,isk)*v(2,n1)+skew(k3,isk)*v(3,n1)
125 a(1,n1)=a(1,n1)+skew(k1,isk)*ms(n1)*aa
126 a(2,n1)=a(2,n1)+skew(k2,isk)*ms(n1)*aa
127 a(3,n1)=a(3,n1)+skew(k3,isk)*ms(n1)*aa
128 IF(ib(j)>0) wfextt=wfextt+half*(a0+aa)*ms(n1)*vv*dt1*weight(n1)
129 ENDDO
130 ENDIF
131 END DO
132
133
134 wfext = wfext + wfextt
135
136 RETURN
character *2 function nl()