/[PAMELA software]/DarthVader/TrackerLevel2/src/F77/filladc.f
ViewVC logotype

Diff of /DarthVader/TrackerLevel2/src/F77/filladc.f

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 1.2 by pam-fi, Tue May 30 16:30:37 2006 UTC revision 1.11 by mocchiut, Thu Jan 16 15:29:53 2014 UTC
# Line 2  Line 2 
2    
3    
4        include 'commontracker.f'        include 'commontracker.f'
       include 'common_reduction.f'  
5        include 'level0.f'        include 'level0.f'
6          include 'level1.f'
7        include 'calib.f'        include 'calib.f'
8    
9    
10          include 'common_reduction.f'
11    
12        external nvk        external nvk
13        external nst        external nst
14    
# Line 29  C     in the third case ADC is filled wi Line 31  C     in the third case ADC is filled wi
31  C---------------------------------------------------------  C---------------------------------------------------------
32    
33        idata=0                   !datatracker array index        idata=0                   !datatracker array index
34    
35        do iv=1,nviews        do iv=1,nviews
36          DSPn=DSPnumber(iv)  
37          ievent=eventn(iv)           DSPn   = DSPnumber(iv)
38             ievent = eventn(iv)
39                    
40  C     ---------------------------  C     ---------------------------
41  C     if the iv view is missing  C     if the iv view is missing
42  C     or the data buffer is empty  C     or the data buffer is empty
43  C     jump to end  C     jump to next view
44  C     ---------------------------  C     ---------------------------
         if(DSPn.eq.0  
      $       .or.datalength(iv).eq.0)goto 333  
45    
46             nword_DSP = 0
47             if(DSPn.eq.0
48         $        .or.DSPn.gt.nviews
49         $        .or.datalength(iv).eq.0)goto 333
50    
51  C++++++++++++++++++++++++++++++++++++++++++++++++++++++  C++++++++++++++++++++++++++++++++++++++++++++++++++++++
52  c     if(iand(DAQmode(iv),z'0002').eq.z'0002') then           if(  iand(DAQmode(iv),z'0003').eq.z'0002'.or.
53          if(iand(DAQmode(iv),z'0003').eq.z'0002'.or.       $        iand(DAQmode(iv),z'0003').eq.z'0003'.or.
54       $       iand(DAQmode(iv),z'0003').eq.z'0003'.or.       $        iand(DAQmode(iv),z'0003').eq.z'0000'.or.
55       $       iand(DAQmode(iv),z'0003').eq.z'0000'.or.       $        .false.) then
      $       .false.) then  
56  C++++++++++++++++++++++++++++++++++++++++++++++++++++++  C++++++++++++++++++++++++++++++++++++++++++++++++++++++
57  C--------------------------------------compressed mode  C--------------------------------------compressed mode
58            is = 0              if(debug.eq.1)print*,'DSP #',DSPn,' --> compressed '
59            il = 0              is = 0
60            prec_ind = 0              il = 0
61   222      continue              prec_ind = 0
62            idata = idata+1   222        continue
63            word=datatracker(idata)              idata = idata+1
64  c$$$          print*,'word(',idata,')= ',datatracker(idata)              if( idata.gt.NWORDMAX )goto 335 !end to end
65                nword_DSP = nword_DSP +1
66                if(  nword_DSP.gt.datalength(iv) )then
67                   if( debug.eq.1 )
68         $              print*,'filladc --> missing end-of-ladder',
69         $              ' in COMPRESSED mode - DSP ',DSPn
70                   if(debug.eq.1)
71         $              print*,'datalength = ',datalength(iv)
72                   iflag=1
73    c               GOOD1(DSPn) = 10
74    c               GOOD1(DSPn) = GOOD1(DSPn) + 2**4
75                   GOOD1(DSPn) = ior(GOOD1(DSPn),2**4)
76                   goto 334         !next view
77                endif
78    c            word = datatracker(idata)
79                word = INT(IBITS(datatracker(idata),0,16),2) ! EM GCC4.2, I checked that this line works
80    c            print *,word,' datatracker(idata) ',datatracker(idata) ! EM
81  C------------------------------------------------------  C------------------------------------------------------
82  C     call routine to uncompress data  C     call routine to uncompress data
83  C------------------------------------------------------  C------------------------------------------------------
84            call compdecode(word,flag,tipo,info,errflag)              call compdecode(word,flag,tipo,info,errflag)
   
           if(errflag.ne.0.) then  
             if(debug)print*,'filladc --> ERROR on compdecode'  
             iflag=1  
             return  
           endif  
   
           if(flag.eq.1) then    !   flag: fine messaggio (ladder)  
   
             if(info.ne.1.and.info.ne.2.and.info.ne.3) then  
               if(debug)print*,  
      $             'filladc --> wrong end-of-ladder '  
      $             //'in COMPRESSED mode'  
               if(debug)print*,  
      $             '            info(=ladder) ',info,'  type ',tipo  
               iflag=1  
               return  
             endif  
85                            
86              il = info              if(errflag.ne.0.) then
87              do js=is+1,1024*il                 if(debug.eq.1)print*,'filladc --> ERROR on compdecode'
88                newVAL=oldVAL-pedestal_t(DSPn,nvk(is),nst(is))                 iflag=1
89       $             +pedestal_t(DSPn,nvk(js),nst(js))  c               GOOD1(DSPn) = 10
90                newVAL=max(0,newVAL)  c               GOOD1(DSPn) = GOOD1(DSPn) + 2**4
91                newVAL=min(4095,newVAL)                 GOOD1(DSPn) = ior(GOOD1(DSPn),2**4)
92                adc(DSPn,nvk(js),nst(js))=newVAL  c               return
93  c$$$              print*,DSPn,nvk(js),nst(js)                 goto 221
94  c$$$     $             ,pedestal_t(DSPn,nvk(js),nst(js)),newval              endif
 c$$$     $             ,pedestal(DSPn,nvk(js),nst(js))  
             enddo  
95                            
96              if(info.eq.3) goto 1000              if(flag.eq.1) then  !   flag: fine messaggio (ladder)
97                  
98                   if(info.ne.1.and.info.ne.2.and.info.ne.3) then
99                      if(debug.eq.1)print*,
100         $                 'filladc --> wrong end-of-ladder '
101         $                 //'in COMPRESSED mode'
102                      if(debug.eq.1)print*,
103         $                 '            info(=ladder) ',info,'  type ',tipo
104                      iflag=1
105    c                  GOOD1(DSPn) = 10
106    c               GOOD1(DSPn) = GOOD1(DSPn) + 2**4
107                   GOOD1(DSPn) = ior(GOOD1(DSPn),2**4)
108    c                  return
109                      goto 221
110                   endif
111                  
112                   il = info
113                   do js=is+1,1024*il
114                      
115                      if( DSPn.le.nviews
116         $                 .and.nvk(js).gt.0
117         $                 .and.nvk(js).le.nva1_view
118         $                 .and.nst(js).gt.0
119         $                 .and.nst(js).le.nstrips_va1
120         $                 )then
121    
122                         newVAL = 0
123                         if(  
124         $                    nvk(is).gt.0.and.
125         $                    nvk(is).le.nva1_view.and.
126         $                    nst(is).gt.0.and.
127         $                    nst(is).le.nstrips_va1.and.
128         $                    .true.)then
129                            newVAL=oldVAL-
130         $                       nint(pedestal_t(DSPn,nvk(is),nst(is)) ! EM GCC4.7
131         $                       +pedestal_t(DSPn,nvk(js),nst(js)),2) ! EM GCC4.7
132                            newVAL=max(int(0,2),newVAL) ! EM GCC4.7
133                            newVAL=min(int(4095,2),newVAL)
134                         endif
135                         adc(DSPn,nvk(js),nst(js))=newVAL
136                      else                    
137                         print*,'filladc -->'
138         $                    ,' attempt to access array element (1)'
139    c     $                    ,'(',DSPn,nvk(is),nst(is),')'
140         $                    ,'pedestal_t(',DSPn,nvk(js),nst(js),')'
141                      endif
142    c$$$  print*,DSPn,nvk(js),nst(js)
143    c$$$  $             ,pedestal_t(DSPn,nvk(js),nst(js)),newval
144    c$$$  $             ,pedestal(DSPn,nvk(js),nst(js))
145                   enddo
146                  
147                   if(info.eq.3) goto 1000
148                  
149                   is=1024*il
150                   prec_ind=0       !il precedente non e' un indirizzo
151                endif
152                            
153              is=1024*il              if(flag.eq.0) then  !  flag: dato o indirizzo
154              prec_ind=0          !il precedente non e' un indirizzo                 if(tipo.eq.1) then ! tipo: indirizzo
155            endif                    iaddr = info + il*1024
156                                if(iaddr.ge.is+1.and.iaddr.le.3072) then
157            if(flag.eq.0) then    !  flag: dato o indirizzo                      
158              if(tipo.eq.1) then  ! tipo: indirizzo                       if(is.eq.0.or.is.eq.1024.or.is.eq.2048)then
159                iaddr = info + il*1024                          if(debug.eq.1)print*,'filladc -->'
160                if(iaddr.ge.is+1.and.iaddr.le.3072) then       $                       ,' previous transmitted strip ',is
161                  do js = is+1,iaddr-1       $                       ,' - missing first ADC value'
162                    newVAL=oldVAL-pedestal_t(DSPn,nvk(is),nst(is))                          iflag=1
163       $                 +pedestal_t(DSPn,nvk(js),nst(js))  c                        GOOD1(DSPn) = 10
164                    newVAL=max(0,newVAL)  c                        GOOD1(DSPn) = GOOD1(DSPn) + 2**4
165                    newVAL=min(4095,newVAL)                          GOOD1(DSPn) = ior(GOOD1(DSPn),2**4)
166                         endif
167                    adc(DSPn,nvk(js),nst(js))=newVAL                       do js = is+1,iaddr-1
168    
169                            if( DSPn.le.nviews
170         $                       .and.nvk(js).gt.0
171         $                       .and.nvk(js).le.nva1_view
172         $                       .and.nst(js).gt.0
173         $                       .and.nst(js).le.nstrips_va1
174         $                       )then
175                              
176                               newVAL = 0
177                               if(
178         $                          nvk(is).gt.0.and.
179         $                          nvk(is).le.nva1_view.and.
180         $                          nst(is).gt.0.and.
181         $                          nst(is).le.nstrips_va1.and.
182         $                          .true.)then
183                                  newVAL=oldVAL-nint( ! EM GCC4.7
184         $                             -pedestal_t(DSPn,nvk(is),nst(is))
185         $                             +pedestal_t(DSPn,nvk(js),nst(js)),2)! EM GCC4.7
186                                  newVAL=max(int(0,2),newVAL)! EM GCC4.7
187                                  newVAL=min(int(4095,2),newVAL)! EM GCC4.7
188                               endif
189                               adc(DSPn,nvk(js),nst(js))=newVAL
190                            else
191                               print*,'filladc -->'
192         $                          ,' attempt to access array element (2) '
193    c     $                          ,'(',DSPn,nvk(is),nst(is),')'
194         $                          ,'pedestal_t(',DSPn,nvk(js),nst(js),')'
195    c                           iflag=1
196    c                           if(DSPn.le.nviews)GOOD1(DSPn) = 10
197                            endif
198  c     print*,DSPn,nvk(js),nst(js),newval  c     print*,DSPn,nvk(js),nst(js),newval
199                            
200                  enddo                       enddo
201                        
202                  is = iaddr                       is = iaddr
203                  prec_ind = 1                       prec_ind = 1
204                else                    else
205                  if(debug)print*,'filladc --> address '//                       if(debug.eq.1)print*,'filladc --> address '//
206       $               'out of range - iaddr,is',iaddr,is       $                    'out of range - iaddr,is',iaddr,is
207                  iflag=1                       iflag=1
208                  return  c                     GOOD1(DSPn) = 10
209                endif  c                     GOOD1(DSPn) = GOOD1(DSPn) + 2**4
210              endif                       GOOD1(DSPn) = ior(GOOD1(DSPn),2**4)
211              if(tipo.eq.0) then  ! tipo: dato    c                     return
212                if(prec_ind.eq.0) is=is+1                       goto 221
213                if(info.ge.0.and.info.le.4095) then                    endif
214                  if(is.gt.3072)then                 endif
215                    if(debug)print*,                 if(tipo.eq.0) then ! tipo: dato  
216       $                 'filladc --> strip out of range - DSPn,is'                    if(prec_ind.eq.0) is=is+1
217       $                 ,DSPn,is                    if(info.ge.0.and.info.le.4095) then
218                    iflag=1                       if(is.gt.3072)then
219                    return                          if(debug.eq.1)print*,
220                  endif       $                       'filladc --> strip out of range - DSPn,is'
221                  newVAL=info       $                       ,DSPn,is
222                                            iflag=1
223                  adc(DSPn,nvk(is),nst(is))=newVAL  c                        GOOD1(DSPn) = 10
224    c                        GOOD1(DSPn) = GOOD1(DSPn) + 2**4
225                            GOOD1(DSPn) = ior(GOOD1(DSPn),2**4)
226    c                        return
227                            goto 221
228    
229                         endif
230                         newVAL=info
231                        
232                         if(       DSPn.le.nviews
233         $                    .and.nvk(is).le.nva1_view
234         $                    .and.nst(is).le.nstrips_va1)then
235                            adc(DSPn,nvk(is),nst(is))=newVAL
236                         else
237                            print*,'filladc --> attempt to access ADC('
238         $                       ,DSPn,nvk(is),nst(is),')'
239                         endif
240  ccc   print*,DSPn,nvk(is),nst(is),newval  ccc   print*,DSPn,nvk(is),nst(is),newval
241                                        
242                  oldVAL=newVAL                       oldVAL=newVAL
243                else                    else
244                  if(debug)                       if(debug.eq.1)
245       $               print*,'filladc --> datum out of range - info',info       $                    print*,'filladc --> datum out of range - info'
246                  iflag=1       $                    ,info
247                  return                       iflag=1
248                endif  c                     GOOD1(DSPn) = 10
249                prec_ind=0  c                     GOOD1(DSPn) = GOOD1(DSPn) + 2**4
250                         GOOD1(DSPn) = ior(GOOD1(DSPn),2**4)
251    c                     return
252                         goto 221
253                      endif
254                      prec_ind=0
255                   endif
256              endif              endif
257            endif   221        continue
258            goto 222              goto 222
259          endif           endif
260            
261   1000   continue   1000    continue
262            
263    
264  C++++++++++++++++++++++++++++++++++++++++++++++++++++++  C++++++++++++++++++++++++++++++++++++++++++++++++++++++
265  c     if(iand(DAQmode(iv),z'0001').eq.z'0001') then  c     if(iand(DAQmode(iv),z'0001').eq.z'0001') then
266          if(iand(DAQmode(iv),z'0003').eq.z'0001'.or. !full           if(iand(DAQmode(iv),z'0003').eq.z'0001'.or. !full
267       $       iand(DAQmode(iv),z'0003').eq.z'0003'.or. !comp+full       $        iand(DAQmode(iv),z'0003').eq.z'0003'.or. !comp+full
268       $       (iand(DAQmode(iv),z'0003').eq.z'0000' !special       $        (iand(DAQmode(iv),z'0003').eq.z'0000' !special
269       $       .and.mod(DSPn+ievent,2).eq.1).or.       $        .and.mod(DSPn+ievent,2).eq.1).or.
270       $       .false.) then       $        .false.) then
271  C++++++++++++++++++++++++++++++++++++++++++++++++++++++  C++++++++++++++++++++++++++++++++++++++++++++++++++++++
272  C--------------------------------------------full mode  C--------------------------------------------full mode
273                
274                if(debug.eq.1)print*,'DSP #',DSPn,' --> full '
275    
276                do i=1,3            !loop over ladder
277            do i=1,3                 do j=1,1024      !loop over strips
278              do j=1,1024                    idata = idata+1
279                idata = idata+1                    if( idata.gt.NWORDMAX )goto 335 !go to end
280                is=j+1024*(i-1)                    nword_DSP = nword_DSP +1
281                      if(  nword_DSP.gt.datalength(iv) )then
282                         if( debug.eq.1 )
283         $                    print*,'filladc --> missing end-of-ladder',
284         $                    ' in FULL mode - DSP ',DSPn
285                         if(debug.eq.1)print*,'datalength = ',datalength
286                         goto 334   !next view
287                      endif
288                      is=j+1024*(i-1)
289  c     adcadc=adc(DSPn,nvk(is),nst(is))  c     adcadc=adc(DSPn,nvk(is),nst(is))
290                adc(DSPn,nvk(is),nst(is)) = datatracker(idata)                    if(       DSPn.le.nviews
291                       $                 .and.nvk(is).le.nva1_view
292         $                 .and.nst(is).le.nstrips_va1)then
293                         adc(DSPn,nvk(is),nst(is))= datatracker(idata)
294                      else
295                         print*,'filladc --> attempt to access ADC['
296         $                    ,DSPn,nvk(is),nst(is),']'
297                      endif
298                      
299  c     if(iand(DAQmode(iv),z'0002').eq.z'0002') then  c     if(iand(DAQmode(iv),z'0002').eq.z'0002') then
300  c     diff=adc(DSPn,nvk(is),nst(is))-adcadc  c     diff=adc(DSPn,nvk(is),nst(is))-adcadc
301  c     if(abs(diff).gt.0)  c     if(abs(diff).gt.0)
302  c     $                    print*,DSPn,is,adcadc,  c     $                    print*,DSPn,is,adcadc,
303  c     $                    ' ---- ',adc(DSPn,nvk(is),nst(is)),diff  c     $                    ' ---- ',adc(DSPn,nvk(is),nst(is)),diff
304  c     endif  c     endif
305              enddo                 enddo            !loop over strips
306              idata = idata+1                 idata = idata+1
307              if(datatracker(idata).ne.ior(z'1800',i+3)) then                 if( idata.gt.NWORDMAX )goto 335 !go to end
308                if(debug)                 nword_DSP = nword_DSP +1
309       $           print*,'filladc --> wrong end-of-ladder in FULL mode'                 if(  nword_DSP.gt.datalength(iv) )then
310                if(debug)                    if( debug.eq.1 )
311       $           print*,'            word ',datatracker(idata)       $                 print*,'filladc --> missing end-of-ladder',
312                if(debug)       $                 ' in FULL mode - DSP ',DSPn
313       $           print*,'            should be ',ior(z'1800',i+3)                    if(debug.eq.1)print*,'datalength = ',datalength
314                iflag=1                    goto 334      !next view
315                return                                   endif
316              endif                 if(datatracker(idata).ne.ior(z'1800',i+3)) then
317            enddo                    if(debug.eq.1)
318          endif       $                 print*,'filladc --> ',
319         $                 'wrong end-of-ladder in FULL mode'
320                      if(debug.eq.1)
321         $                 print*,'            word ',datatracker(idata)
322                      if(debug.eq.1)
323         $                 print*,'            should be ',ior(z'1800',i+3)
324                      iflag=1
325    c                  GOOD1(DSPn) = 10
326    c                  GOOD1(DSPn) = GOOD1(DSPn) + 2**4
327                      GOOD1(DSPn) = ior(GOOD1(DSPn),2**4)
328    c                  return                  
329                   endif
330                enddo!endl loop over ladder
331             endif
332             goto 334
333     333     continue
334             if(debug.eq.1)print*,'filladc --> ',iv
335         $        ,'^ DSP packet missing or corrupted: '
336         $        ,'DSPn, datalength(iv) => '
337         $        ,DSPn,datalength(iv)
338     334     continue
339        enddo        enddo
340   333  continue        goto 336
341           335  continue
342          if(debug.eq.1)print*,'filladc --> reached end of buffer:',
343         $     ' datatracker(',NWORDMAX,')'
344    
345     336  continue
346        return        return
347        end        end
348    
# Line 204  c     qui o nelle functions.f??? Line 352  c     qui o nelle functions.f???
352                
353        SUBROUTINE COMPDECODE(word,flag,tipo,info,errflag)        SUBROUTINE COMPDECODE(word,flag,tipo,info,errflag)
354        INTEGER*2 word,flag,tipo,info        INTEGER*2 word,flag,tipo,info
355          INTEGER*2 hexmask !EM GCC4.7
356  C-------------------------------------------------------  C-------------------------------------------------------
357  C     Decode tracker words:  C     Decode tracker words:
358  C      C    
# Line 215  C     1       0(end of ladders 1 2  1,2 Line 364  C     1       0(end of ladders 1 2  1,2
364  C     1       1(end of ladder 3)    3 or 6  C     1       1(end of ladder 3)    3 or 6
365  C-------------------------------------------------------  C-------------------------------------------------------
366        errflag=0.        errflag=0.
367        flag=iand(word,z'f000')  C EM: by default z'XXXX' returns a INTEGER*8, we want to have just a INTEGER*2 so we need a trick
368    C Bitwise is like this:
369    C WORD =  16 bit
370    C         1111111111111111  FFFF  32767 + sign
371    C
372    C      flag=iand(word,z'f000')
373          hexmask=z'7000'
374          hexmask=IBSET(hexmask,15) ! it is not possible to set the sign bit with F000, we must set the sign bit with ibset
375          flag=iand(word,hexmask)
376    C END EM
377        flag=ishft(flag,-12)        flag=ishft(flag,-12)
378    
379        if(flag.ne.0.and.flag.ne.1) then        if(flag.ne.0.and.flag.ne.1) then
380  c        print*,'compdecode --> error on uncompression: flag=',flag  c        print*,'compdecode --> error on uncompression: flag=',flag
381          errflag=1.           errflag=1.
382        endif        endif
383        if(flag.eq.0) then        ! valore ADC        if(flag.eq.0) then        ! valore ADC
384          tipo=0           tipo=0
385          info=iand(word,z'0fff')           hexmask=z'0FFF' !EM GCC4.7
386             info=iand(word,hexmask) !EM GCC4.7
387    c         info=iand(word,z'0fff') !EM GCC4.7
388        endif        endif
389        if(flag.eq.1) then        ! indirizzo OR fine vista        if(flag.eq.1) then        ! indirizzo OR fine vista
390          info=iand(word,z'03ff')          hexmask=z'03FF' !EM GCC4.7
391          tipo=iand(word,z'0c00')          info=iand(word,hexmask) !EM GCC4.7
392          if(tipo.ne.0.and.tipo.ne.z'0800') then  c        info=iand(word,z'03ff') !EM GCC4.7
393            hexmask=z'0C00' !EM GCC4.7
394            tipo=iand(word,hexmask)!EM GCC4.7
395    c        tipo=iand(word,z'0c00') !EM GCC4.7
396            hexmask=z'0800' !EM GCC4.7
397            if(tipo.ne.0.and.tipo.ne.hexmask) then !EM GCC4.7
398  c          print*,'compdecode --> error on decompression: tipo=',tipo  c          print*,'compdecode --> error on decompression: tipo=',tipo
399            errflag=1.            errflag=1.
400          endif          endif
401          if(tipo.eq.0) then      ! indirizzo          if(tipo.eq.0) then      ! indirizzo
402            flag=0            flag=0
403            tipo=1            tipo=1
404            info=info+1            info=info+INT(1,2) !EM GCC4.7
405          endif          endif
406          if(tipo.eq.z'0800') then ! fine vista          if(tipo.eq.z'0800') then ! fine vista
407            flag=1            flag=1
Legend:
Removed from v.1.2  
changed lines
  Added in v.1.11
  ViewVC Help
Powered by ViewVC 1.1.23