1 |
kusanagi |
1.1 |
C-------------------------------------------------------------------- |
2 |
|
|
SUBROUTINE TOFUNPACK(vecta,lung,me) |
3 |
kusanagi |
6.1 |
|
4 |
|
|
C modified D.Campana, Mar. 06 |
5 |
kusanagi |
1.1 |
C D.Campana, Dec. 04 |
6 |
kusanagi |
6.1 |
C-------------------------------------------------------------------- |
7 |
kusanagi |
1.1 |
|
8 |
|
|
IMPLICIT NONE |
9 |
|
|
|
10 |
|
|
C |
11 |
|
|
C Normal variables definition |
12 |
|
|
C |
13 |
|
|
integer lung |
14 |
|
|
integer*1 vecta(lung) |
15 |
kusanagi |
6.1 |
integer*1 vectof(lung,16) |
16 |
kusanagi |
4.1 |
integer*2 ibuf |
17 |
kusanagi |
1.1 |
integer me |
18 |
|
|
integer check, crctof |
19 |
|
|
integer ic0,sup,inf |
20 |
kusanagi |
6.1 |
integer i, ic, bit, bi,j ,iadd, iword,iw,idw,iup,ind |
21 |
|
|
integer start,ntdc,tdcfirst,tdccodeq,tdccodet |
22 |
|
|
integer tdcnum(12), boardnum(12) |
23 |
|
|
integer tdcadd(8),coldadd(8) |
24 |
kusanagi |
1.1 |
integer tdcid(12),evcount(12) |
25 |
|
|
integer tdcmask(12),adc(4,12),tdc(4,12) |
26 |
|
|
integer rawadc(4,12),rawtdc(4,12),grayadc(4,12),graytdc(4,12) |
27 |
|
|
integer temp1(12),temp2(12) |
28 |
kusanagi |
4.1 |
logical flag2 |
29 |
kusanagi |
6.1 |
integer ii,ik,adc_ch2,tdc_ch1,icorr |
30 |
|
|
integer dsphot,dspcold,code |
31 |
kusanagi |
1.1 |
C |
32 |
|
|
c data start,ntdc /150,12/ ! to read data before Christmas 2004 |
33 |
kusanagi |
6.1 |
data start,ntdc /153,12/ ! to read data after Christmas 2004 |
34 |
|
|
data tdcadd /1,0,3,2,5,4,7,6/ |
35 |
|
|
data coldadd /6,7,4,5,2,3,0,1/ |
36 |
kusanagi |
1.1 |
|
37 |
|
|
COMMON / tofvar /tdcid,evcount,tdcmask,adc,tdc,temp1,temp2 |
38 |
|
|
save / tofvar / |
39 |
kusanagi |
6.1 |
|
40 |
kusanagi |
1.1 |
C |
41 |
kusanagi |
6.1 |
c----+---1---------2---------3---------4---------5---------6---------7---------8 |
42 |
|
|
C Begin ! |
43 |
|
|
C 'start' is a pointer to the ToF data |
44 |
|
|
c----+---1---------2---------3---------4---------5---------6---------7---------8 |
45 |
kusanagi |
1.1 |
|
46 |
|
|
C |
47 |
|
|
ic = start |
48 |
|
|
C |
49 |
|
|
c print *,'++++++++++ Tof Unpack ++++++++++++++++' |
50 |
|
|
|
51 |
kusanagi |
6.1 |
dspcold = 0 |
52 |
|
|
dsphot = 0 |
53 |
|
|
|
54 |
kusanagi |
1.1 |
do j = 1,ntdc |
55 |
kusanagi |
4.1 |
flag2=.true. |
56 |
|
|
ic0 = ic ! first index for the CRC computation |
57 |
kusanagi |
1.1 |
tdcid(j) = 0 |
58 |
|
|
evcount(j) = 0 |
59 |
kusanagi |
6.1 |
tdcnum(j) = 0 ! the 4 MSBs in TDCid |
60 |
|
|
boardnum(j) = 0 ! the 4 LSBs in TDCid |
61 |
kusanagi |
1.1 |
do bit = 0, 7 |
62 |
|
|
bi = ibits(vecta(ic),bit,1) |
63 |
kusanagi |
6.1 |
if (bi.eq.1)then |
64 |
|
|
tdcid(j) = ibset(tdcid(j),bit) |
65 |
|
|
if (bit.le.3)then |
66 |
|
|
boardnum(j) = ibset(boardnum(j),bit) |
67 |
|
|
else |
68 |
|
|
tdcnum(j) = ibset(tdcnum(j),bit-4) |
69 |
|
|
endif |
70 |
|
|
endif |
71 |
kusanagi |
1.1 |
bi = ibits(vecta(ic+1),bit,1) |
72 |
|
|
if (bi.eq.1) evcount(j) = ibset(evcount(j),bit) |
73 |
|
|
enddo |
74 |
kusanagi |
6.1 |
c print *,'tdcnum(j),boardnum(j)' |
75 |
|
|
c print *, tdcnum(j),boardnum(j) |
76 |
kusanagi |
1.1 |
c |
77 |
|
|
ic=ic+2 |
78 |
|
|
tdcmask(j) = 0 |
79 |
|
|
do bit = 0, 7 |
80 |
|
|
bi = ibits(vecta(ic),bit,1) |
81 |
|
|
if (bi.eq.1) tdcmask(j) = ibset(tdcmask(j),bit+8) |
82 |
|
|
bi = ibits(vecta(ic+1),bit,1) |
83 |
|
|
if (bi.eq.1) tdcmask(j) = ibset(tdcmask(j),bit) |
84 |
|
|
enddo |
85 |
kusanagi |
4.1 |
c |
86 |
kusanagi |
1.1 |
ic=ic+2 |
87 |
kusanagi |
4.1 |
c |
88 |
|
|
c |
89 |
kusanagi |
6.1 |
c if the first word RAWADC are equal to 0 |
90 |
kusanagi |
4.1 |
c the data storage is shifted by a word --> ic = ic+1 |
91 |
|
|
c and TEMP2 is overwritten by the CRC --> flag2=.false. |
92 |
|
|
c |
93 |
|
|
tdcfirst = 0 |
94 |
kusanagi |
6.1 |
do bit = 0,7 |
95 |
kusanagi |
4.1 |
bi = ibits(vecta(ic),bit,1) |
96 |
kusanagi |
6.1 |
if (bi.eq.1) tdcfirst = ibset(tdcfirst,bit) |
97 |
kusanagi |
4.1 |
enddo |
98 |
|
|
if (tdcfirst.eq.0) then |
99 |
|
|
ic=ic+1 |
100 |
|
|
flag2=.false. |
101 |
|
|
endif |
102 |
|
|
c |
103 |
kusanagi |
6.1 |
c ----- se stiamo acquisendo con il DSP cold, bisogna tener conto |
104 |
|
|
c ----- che c'e' un' inversione nel cavo che va alla scheda 5 |
105 |
|
|
c ----- quindi per TDCnum =1,2 e Boardnum=4 (va da 0 a 5) |
106 |
|
|
c ----- le parole che seguono sono invertite bit a bit |
107 |
|
|
c ----- cioe' si fa il complemento a 2**8-1 =255 |
108 |
|
|
c |
109 |
|
|
if (dspcold.eq.0 .and. dsphot.eq.0) then |
110 |
|
|
if (boardnum(j).eq.4)then |
111 |
|
|
if((tdcnum(j).eq.1).or.(tdcnum(j).eq.2))then |
112 |
|
|
code = 0 |
113 |
|
|
do bit = 5,7 |
114 |
|
|
bi = ibits(vecta(ic),bit,1) |
115 |
|
|
if (bi.eq.1) code = ibset(code,bit-5) |
116 |
|
|
enddo |
117 |
|
|
if (code.eq.coldadd(1)) dspcold = 1 |
118 |
|
|
if (code.eq.tdcadd(1)) dsphot = 1 |
119 |
|
|
endif |
120 |
|
|
endif |
121 |
|
|
endif |
122 |
|
|
c |
123 |
|
|
do i=1,16 |
124 |
|
|
do iword=0,17 |
125 |
|
|
vectof(ic+iword,i)=0 |
126 |
|
|
enddo |
127 |
|
|
enddo |
128 |
|
|
c |
129 |
|
|
do iword=0,17 ! le parole successive sono copiate in vectof |
130 |
|
|
vectof(ic+iword,1)=vecta(ic+iword) |
131 |
|
|
enddo |
132 |
|
|
c |
133 |
|
|
if (dspcold.eq.1) then |
134 |
|
|
if (boardnum(j).eq.4)then |
135 |
|
|
if((tdcnum(j).eq.1).or.(tdcnum(j).eq.2))then |
136 |
|
|
do iword=0,17 |
137 |
|
|
vectof(ic+iword,1)= 255 - vecta(ic+iword) |
138 |
|
|
enddo |
139 |
|
|
endif |
140 |
|
|
endif |
141 |
|
|
endif |
142 |
|
|
|
143 |
|
|
c |
144 |
|
|
c -----fine cura inversione cavo FE to DSP cold |
145 |
|
|
c |
146 |
|
|
c |
147 |
|
|
ind=1 ! all'inizio parto da vecta(ic)==vectof(ic,1) |
148 |
|
|
tdc_ch1=0 |
149 |
|
|
adc_ch2=0 |
150 |
|
|
icorr=0 |
151 |
|
|
c |
152 |
|
|
|
153 |
|
|
do i=1,4 ! loop on TDC 4 channels |
154 |
|
|
c print *,'=====================' |
155 |
|
|
c print *,'TDC =',J,' CANALE =',I |
156 |
|
|
|
157 |
|
|
C |
158 |
|
|
C -------------- inizio correzione per le coppie di zeri ------------ |
159 |
|
|
C |
160 |
|
|
c if first 3 bits of the word RAWADC(TDC) are not equal to |
161 |
|
|
c tdcadd(iadd) |
162 |
|
|
c the data storage has to be shifted by 2 bit (are spurious zeroes |
163 |
|
|
c introduced by the F.E.board) |
164 |
|
|
c |
165 |
|
|
c |
166 |
|
|
c Check only on the MSB (bit 13,14 e 15 of 2(+2) word RAWADC(TDC): |
167 |
|
|
c vecta(ic) and vecta(ic+2)) |
168 |
|
|
c |
169 |
|
|
iadd = 2*(i-1)+1 ! = 1,3,5,7 |
170 |
|
|
ii=i |
171 |
|
|
C |
172 |
|
|
C ----------------- Controllo sulla parola ADC |
173 |
|
|
C |
174 |
|
|
11 continue |
175 |
|
|
tdccodeq = 0 |
176 |
|
|
C |
177 |
|
|
do bit = 5,7 |
178 |
|
|
bi = ibits(vectof(ic,ind),bit,1) |
179 |
|
|
if (bi.eq.1) tdccodeq = ibset(tdccodeq,bit-5) |
180 |
|
|
enddo |
181 |
|
|
C |
182 |
|
|
if (tdccodeq.ne.tdcadd(iadd)) then |
183 |
|
|
c |
184 |
|
|
c------------- controllo che la colpa dei 2 zeri non sia di TDC(ch1) |
185 |
|
|
c |
186 |
|
|
if ((iadd.eq.3).and.(tdc_ch1.eq.0))then |
187 |
|
|
if (tdccodeq.ne.0) then |
188 |
|
|
c print *,'2 zeri in ADC, ma la colpa forse e` del TDC' |
189 |
|
|
ic=ic-4 |
190 |
|
|
iadd=1 |
191 |
|
|
ii=1 |
192 |
|
|
adc_ch2=99 |
193 |
|
|
goto 12 |
194 |
|
|
endif |
195 |
|
|
endif |
196 |
|
|
c--------------- fine controllo |
197 |
|
|
c |
198 |
|
|
c PRINT *, '---------shift di 2 zeri sui dati ADC ! ' |
199 |
|
|
c print *,'numero di tdc = ',j,', ind = ',ind |
200 |
|
|
c print *,'vectof(ic,ind),tdccodeq,tdcadd(iadd),iadd' |
201 |
|
|
c print *,vectof(ic,ind),tdccodeq,tdcadd(iadd),iadd |
202 |
|
|
c |
203 |
|
|
iup = 17-4*(ii-1) |
204 |
|
|
idw = 0 |
205 |
|
|
do iw=idw,iup |
206 |
|
|
do bit = 0, 7 |
207 |
|
|
if(bit.le.5)then |
208 |
|
|
bi = ibits(vectof(ic+iw,ind),bit,1) |
209 |
|
|
if (bi.eq.1) vectof(ic+iw,ind+1) = |
210 |
|
|
+ ibset(vectof(ic+iw,ind+1),bit+2) |
211 |
|
|
else |
212 |
|
|
bi = ibits(vectof(ic+1+iw,ind),bit,1) |
213 |
|
|
if (bi.eq.1) vectof(ic+iw,ind+1) = |
214 |
|
|
+ ibset(vectof(ic+iw,ind+1),bit-6) |
215 |
|
|
endif |
216 |
|
|
enddo ! loop sui bit |
217 |
|
|
enddo ! loop sulle parole |
218 |
|
|
c |
219 |
|
|
c----+---1---------2---------3---------4---------5---------6---------7---------8 |
220 |
|
|
c |
221 |
|
|
if(iadd.eq.3)adc_ch2=adc_ch2+1 |
222 |
|
|
ind = (ind + 1) ! aggiorno l' indice |
223 |
|
|
if (ind.le.14)then |
224 |
|
|
go to 11 ! rifaccio il check |
225 |
|
|
else |
226 |
|
|
c print *,'exit ADC senza soluzione',ind |
227 |
|
|
endif |
228 |
|
|
endif |
229 |
|
|
|
230 |
|
|
c ------- se e' l'ADC channel 2 bisogna ricontrollare il TDC precedente |
231 |
|
|
|
232 |
|
|
if ((iadd.eq.3).and.(adc_ch2.ge.2).and.(tdc_ch1.eq.0))then |
233 |
|
|
c print *,'ci sono!!!!!!!!!!!!!!!!!!' |
234 |
|
|
c print *,'adc_ch2 = ',adc_ch2 |
235 |
|
|
c print *,'ind = ',ind |
236 |
|
|
ind=ind-adc_ch2 |
237 |
|
|
c print *,'ind - adc_ch2 = ',ind |
238 |
|
|
do ik=1,adc_ch2 |
239 |
|
|
do iword=0,17 |
240 |
|
|
vectof(ic+iword,ind+ik)=0 |
241 |
|
|
enddo |
242 |
|
|
enddo |
243 |
|
|
ic=ic-4 |
244 |
|
|
iadd=1 |
245 |
|
|
ii=1 |
246 |
|
|
goto 12 |
247 |
|
|
endif |
248 |
|
|
c |
249 |
|
|
c --- registro RAWADC |
250 |
|
|
c |
251 |
kusanagi |
1.1 |
rawadc(i,j) = 0 |
252 |
|
|
do bit = 0, 7 |
253 |
kusanagi |
6.1 |
bi = ibits(vectof(ic,ind),bit,1) |
254 |
kusanagi |
1.1 |
if (bi.eq.1) rawadc(i,j) = ibset(rawadc(i,j),bit+8) |
255 |
kusanagi |
6.1 |
bi = ibits(vectof(ic+1,ind),bit,1) |
256 |
kusanagi |
1.1 |
if (bi.eq.1) rawadc(i,j) = ibset(rawadc(i,j),bit) |
257 |
kusanagi |
6.1 |
enddo |
258 |
|
|
C |
259 |
|
|
C |
260 |
|
|
C ----------------- Controllo sulla parola TDC |
261 |
|
|
C |
262 |
|
|
12 continue |
263 |
|
|
tdccodet = 0 |
264 |
|
|
do bit = 5,7 |
265 |
|
|
bi = ibits(vectof(ic+2,ind),bit,1) |
266 |
|
|
if (bi.eq.1) tdccodet = ibset(tdccodet,bit-5) |
267 |
|
|
enddo |
268 |
|
|
if ((tdccodet.ne.tdcadd(iadd+1)).or. |
269 |
|
|
+ ((adc_ch2.ge.2).and.(iadd.eq.1)))then |
270 |
|
|
c----+---1---------2---------3---------4---------5---------6---------7---------8 |
271 |
|
|
c |
272 |
|
|
if(adc_ch2.ge.2)then |
273 |
|
|
adc_ch2=0 |
274 |
|
|
icorr=1 |
275 |
|
|
endif |
276 |
|
|
c PRINT *, '---------shift di 2 zeri sui dati TDC ! ' |
277 |
|
|
c print *,'vectof(ic+2,ind),tdccodet,tdcadd(iadd+1),(iadd+1)' |
278 |
|
|
c print *,vectof(ic+2,ind),tdccodet,tdcadd(iadd+1),(iadd+1) |
279 |
|
|
c |
280 |
|
|
iup = 17-4*(ii-1) |
281 |
|
|
idw =2 |
282 |
|
|
do iw=idw,iup |
283 |
|
|
do bit = 0, 7 |
284 |
|
|
if(bit.le.5)then |
285 |
|
|
bi = ibits(vectof(ic+iw,ind),bit,1) |
286 |
|
|
if (bi.eq.1) vectof(ic+iw,ind+1) = |
287 |
|
|
+ ibset(vectof(ic+iw,ind+1),bit+2) |
288 |
|
|
else |
289 |
|
|
bi = ibits(vectof(ic+1+iw,ind),bit,1) |
290 |
|
|
if (bi.eq.1) vectof(ic+iw,ind+1) = |
291 |
|
|
+ ibset(vectof(ic+iw,ind+1),bit-6) |
292 |
|
|
endif |
293 |
|
|
enddo ! loop sui bit |
294 |
|
|
enddo ! loop sulle parole |
295 |
|
|
c----+---1---------2---------3---------4---------5---------6---------7---------8 |
296 |
|
|
c |
297 |
|
|
if(iadd.eq.1)tdc_ch1=tdc_ch1+1 |
298 |
|
|
ind = (ind + 1) ! aggiorno l' indice |
299 |
|
|
if (ind.le.15) then |
300 |
|
|
go to 12 ! rifaccio il check |
301 |
|
|
else |
302 |
|
|
c print *,'exit TDC senza successo ',ind |
303 |
|
|
endif |
304 |
|
|
endif |
305 |
|
|
c |
306 |
|
|
c --- registro RAWTDC |
307 |
|
|
c |
308 |
|
|
rawtdc(ii,j) = 0 |
309 |
|
|
do bit = 0, 7 |
310 |
|
|
bi = ibits(vectof(ic+2,ind),bit,1) |
311 |
|
|
if (bi.eq.1) rawtdc(ii,j) = ibset(rawtdc(ii,j),bit+8) |
312 |
|
|
bi = ibits(vectof(ic+3,ind),bit,1) |
313 |
|
|
if (bi.eq.1) rawtdc(ii,j) = ibset(rawtdc(ii,j),bit) |
314 |
kusanagi |
1.1 |
enddo |
315 |
|
|
c |
316 |
kusanagi |
6.1 |
c |
317 |
|
|
c ------- se e' il TDC channel 1 e' il risultato dell'iterazione prodotta |
318 |
|
|
c dall' ADC channel 2 bisogna ripassare all' ADC successivo |
319 |
|
|
|
320 |
|
|
if ((iadd.eq.1).and.(icorr.eq.1).and.(tdc_ch1.gt.0))then |
321 |
|
|
iadd=3 |
322 |
|
|
ii=2 |
323 |
|
|
ic=ic+4 |
324 |
|
|
c print *,'sto tornando all ADC dopo aver corr. il TDC',ind |
325 |
|
|
goto 11 |
326 |
|
|
endif |
327 |
|
|
C |
328 |
|
|
C -------------- fine correzione per le coppie di zeri ------------ |
329 |
|
|
C |
330 |
|
|
|
331 |
|
|
ic=ic+4 |
332 |
|
|
enddo ! fine loop sui 4 TDC channel |
333 |
|
|
|
334 |
|
|
c |
335 |
kusanagi |
1.1 |
c adc e tdc data have to be translated from Gray code to binary (bit 0-11) |
336 |
|
|
c bit 12 is added after conversion (control bit) |
337 |
|
|
c bit 13 is 1(0) for charge(time) information |
338 |
|
|
c bits 14-15 give the channel 1-4 on the board. |
339 |
|
|
c |
340 |
kusanagi |
6.1 |
do i=1,4 ! loop on TDC 4 channels |
341 |
|
|
c print *,'=========== graytobin e registro ==========' |
342 |
|
|
c print *,'TDC =',J,' CANALE =',I |
343 |
|
|
grayadc(i,j) = 0 |
344 |
|
|
graytdc(i,j) = 0 |
345 |
|
|
|
346 |
kusanagi |
1.1 |
grayadc(i,j)=ibits(rawadc(i,j),0,12) |
347 |
|
|
graytdc(i,j)=ibits(rawtdc(i,j),0,12) |
348 |
kusanagi |
6.1 |
c |
349 |
|
|
call graytobin(grayadc(i,j),adc(i,j),12) |
350 |
|
|
call graytobin(graytdc(i,j),tdc(i,j),12) |
351 |
|
|
c |
352 |
|
|
bi = ibits(rawtdc(i,j),12,1) |
353 |
|
|
if (bi.eq.1) tdc(i,j) = ibset(tdc(i,j),12) |
354 |
|
|
bi = ibits(rawadc(i,j),12,1) |
355 |
|
|
if (bi.eq.1) adc(i,j) = ibset(adc(i,j),12) |
356 |
|
|
c |
357 |
|
|
c PRINT *,'i, j, RAWadc(i,j) ,RAWtdc(i,j)' |
358 |
|
|
c PRINT *, i, j, rawadc(i,j) ,rawtdc(i,j) |
359 |
|
|
c PRINT *,'i, j, ADC(i,j), TDC(i,j)' |
360 |
|
|
c PRINT *, i, j, adc(i,j), tdc(i,j) |
361 |
|
|
c |
362 |
kusanagi |
1.1 |
enddo |
363 |
kusanagi |
6.1 |
|
364 |
|
|
|
365 |
|
|
c |
366 |
kusanagi |
1.1 |
temp1(j) = 0 |
367 |
|
|
temp2(j) = 0 |
368 |
|
|
do bit = 0, 7 |
369 |
kusanagi |
6.1 |
bi = ibits(vectof(ic,ind),bit,1) |
370 |
kusanagi |
1.1 |
if (bi.eq.1) temp1(j) = ibset(temp1(j),bit) |
371 |
kusanagi |
4.1 |
enddo |
372 |
|
|
ic=ic+1 |
373 |
|
|
c |
374 |
|
|
if (flag2.eqv..true.) then |
375 |
kusanagi |
6.1 |
do bit = 0, 7 |
376 |
|
|
bi = ibits(vectof(ic,ind),bit,1) |
377 |
|
|
if (bi.eq.1) temp2(j) = ibset(temp2(j),bit) |
378 |
|
|
enddo |
379 |
|
|
ic=ic+1 |
380 |
kusanagi |
4.1 |
else |
381 |
kusanagi |
6.1 |
temp2(j) = 99 |
382 |
kusanagi |
4.1 |
endif |
383 |
kusanagi |
6.1 |
c |
384 |
kusanagi |
1.1 |
c vecta(ic) is the CRC |
385 |
|
|
c Check consistency of CRC. |
386 |
|
|
c |
387 |
kusanagi |
4.1 |
ccc if(vecta(ic).lt.0)vecta(ic)=vecta(ic)+256 |
388 |
|
|
|
389 |
|
|
ibuf=0 |
390 |
|
|
do bit = 0, 7 |
391 |
|
|
bi = ibits(vecta(ic),bit,1) |
392 |
|
|
if (bi.eq.1) ibuf = ibset(ibuf,bit) |
393 |
|
|
enddo |
394 |
|
|
c |
395 |
kusanagi |
1.1 |
check = 0 |
396 |
|
|
inf = ic0 |
397 |
|
|
sup = ic - 1 |
398 |
|
|
do i = inf,sup |
399 |
|
|
check=crctof(check,vecta(i)) |
400 |
|
|
enddo |
401 |
kusanagi |
4.1 |
c if (check.ne.vecta(ic)) then |
402 |
|
|
if (check.ne.ibuf) then |
403 |
kusanagi |
6.1 |
print *,'crc wrong ',ibuf, check |
404 |
kusanagi |
1.1 |
me = 1 |
405 |
|
|
endif |
406 |
|
|
|
407 |
|
|
c |
408 |
|
|
c print *,'---------> ic, j' ,ic,j |
409 |
|
|
ic=ic+1 |
410 |
|
|
|
411 |
|
|
enddo ! j = 1,ntdc |
412 |
|
|
|
413 |
|
|
|
414 |
|
|
RETURN |
415 |
|
|
END |