41
42
43
44 USE sensor_mod
45 USE python_funct_mod
46 USE finter_mixed_mod
47
48
49
50#include "implicit_f.inc"
51#include "comlock.inc"
52
53
54
55#include "com04_c.inc"
56#include "com08_c.inc"
57#include "param_c.inc"
58
59
60
61 INTEGER,INTENT(IN) :: NSENSOR
62 TYPE(PYTHON_), INTENT(INOUT) :: PYTHON
63 INTEGER NPC(*)
64 INTEGER ICFIELD(SIZFIELD,*),IB(*)
65 INTEGER WEIGHT(*),ITASK,NRBYAC,IRBYAC(*),NPBY(NNPBY,*),IFRAME(LISKN,*),ISKN(LISKN,*)
66 my_real fac(lfacload,*), tf(*), a(3,*), v(3,*), ms(*),x(3,*), xframe(nxframe,*),wfextt, rby(nrby,*)
67 TYPE (SENSOR_STR_) ,DIMENSION(NSENSOR) ,INTENT(IN) :: SENSOR_TAB
68
69
70
71 INTEGER NL, N1, IFRA, N2, IFUNC, K1, K2, K3, ,K,NN, IAD,J, PROC, IADF, IADL,IDIR,IFLAG,N1FRAM,IUN,JJ,IMOVFRAM
72 my_real nx, ny, nz, axi, a0, aa, vv, fx, fy, fz, ax, ts,
73 . gama, ma, vrot, x0, y0, z0, x1, y1, z1, x2, y2, z2, vrotm1
74 my_real dist(3),arel(3),vn1fram(3),an1fram(3),dw(3)
76
77 EXTERNAL finter
78 DATA iun/1/
79
80
86
87 iadf = iad+itask*nn
88 iadl = iad-1+(itask+1)*nn
89
91 n1fram = 0
92 IF(ifra /= 0) n1fram = iframe(1,ifra)
93 imovfram = 0
94 IF (n1fram /= 0) THEN
95 vn1fram(1) = v(1,n1fram)
96 vn1fram(2) = v(2,n1fram)
97 vn1fram(3) = v(3,n1fram)
98 an1fram(1) = a(1,n1fram)
99 an1fram(2) = a(2,n1fram)
100 an1fram(3) = a(3,n1fram)
101 imovfram = 1
102 ELSE
103 vn1fram(1) = zero
104 vn1fram(2) = zero
105 vn1fram(3) = zero
106 an1fram(1) = zero
107 an1fram(2) = zero
108 an1fram(3) = zero
109 ENDIF
111 IF (ifra == 0) THEN
112
113 x0 = 0
114 y0 = 0
115 z0 = 0
116 x2 = 1
117 y2 = 0
118 z2 = 0
119 ENDIF
120
122 IF(isens==0)THEN
123 ts=tt
124 ELSE
125 ts = tt-sensor_tab(isens)%TSTART
126 IF(ts<0.0)RETURN
127 ENDIF
128
129 vrot = fac(1,
nl)*finter_mixed(python,nfunct,ifunc,ts*fac(2,
nl),npc,tf)
130 vrotm1=vrot
131 IF (dt2 > zero .AND. iflag == 2) vrotm1 = fac(1,
nl)*finter_mixed(python,nfunct,ifunc,(ts-dt2)*fac(2,
nl),npc,tf)
132 x0 = xframe(10,ifra+1)
133 y0 = xframe(11,ifra+1)
134 z0 = xframe(12,ifra+1)
135 IF(idir == 4) THEN
136 x2 = xframe(1,ifra+1)
137 y2 = xframe(2,ifra+1)
138 z2 = xframe(3,ifra+1)
139 ELSEIF(idir == 5) THEN
140 x2 = xframe(4,ifra+1)
141 y2 = xframe(5,ifra+1)
142 z2 = xframe(6,ifra+1)
143 ELSEIF(idir == 6) THEN
144 x2 = xframe(7,ifra+1)
145 y2 = xframe(8,ifra+1)
146 z2 = xframe(9,ifra+1)
147 ENDIF
148
149#include "vectorize.inc"
150 DO j=iadf,iadl
151 n1=iabs(ib(j))
152 x1 = x(1,n1)-x0
153 y1 = x(2,n1)-y0
154 z1 = x(3,n1)-z0
155 dist(1)=x1-(x1*x2+y1*y2+z1*z2)*x2
156 dist(2)=y1-(x1*x2+y1*y2+z1*z2)*y2
157 dist(3)=z1-(x1*x2+y1*y2+z1*z2)*z2
158 IF (dt2 > 0 .AND. iflag == 2) THEN
159 dw(1) = ((vrot-vrotm1)/dt2)*x2
160 dw(2) = ((vrot-vrotm1)/dt2)*y2
161 dw(3) = ((vrot-vrotm1)/dt2)*z2
162 arel(1) = dist(1)*vrot*vrot + dist(2) * dw(3) - dist(3) * dw(2)
163 arel(2) = dist(2)*vrot*vrot + dist(3) * dw(1) - dist(1) * dw(3)
164 arel(3) = dist(3)*vrot*vrot + dist(1) * dw(2) - dist(2) * dw(1)
165 ELSE
166 arel(1) = dist(1)*vrot*vrot
167 arel(2) = dist(2)*vrot*vrot
168 arel(3) = dist(3)*vrot*vrot
169 ENDIF
170 IF (imovfram == 1)
171 .
CALL relfram_m1(x(1,n1) ,v(1,n1), arel , xframe, vn1fram , an1fram )
172 a(1,n1)=a(1,n1)+arel(1)*ms(n1)
173 a(2,n1)=a(2,n1)+arel(2)*ms(n1)
174 a(3,n1)=a(3,n1)+arel(3)*ms(n1)
175 IF(ib(j)>0)
176 . wfextt=wfextt + half*ms(n1)*x1*x1*(vrot-vrotm1)*(vrot-vrotm1)
177 ENDDO
178
179 ENDDO
180
181 RETURN
subroutine relfram_m1(xg, vg, arel, xframe, vo, ao)
character *2 function nl()