HarpoDccPacket.cxx

Go to the documentation of this file.

/*******************************************************************************
                           HARPO readout
                           _____________________

 File:        hrpfmt.c

 Description: This module profide fortran function for dcc header decoding

 Author: Igor Semeniouk semenjuk@llr.in2p3.fr

 Use code from  D. Calvet calvet@hep.saclay.cea.fr clientUDP
              

 History:
  February 2012: created from content extracted in ethpacked.c
  
*******************************************************************************/

#include "HarpoDccPacket.h"
#include "dccmacro.h"

#include <arpa/inet.h>
#include <strings.h>
#include <stdio.h>

/*******************************************************************************
+++ FemAdcDataDecode 
*******************************************************************************/
static void FemAdcDataDecode(DataPacketV2 *pck, HarpoDccFrame *hdr)
{
        unsigned int ts;
        
        hdr->size = pck->size;

        hdr->swversion =  ((DATA_PACKET_VER(pck->dcchdr)==0) ? 1 : 2);
        hdr->pkgtype   =        GET_FRAME_TY_V2(pck->dcchdr);
        hdr->dccindex  =        GET_DCC_INDEX(pck->dcchdr);
        hdr->femindex  =        GET_FEM_INDEX(pck->dcchdr);

        hdr->msgtype =  GET_RESP_TYPE(pck->hdr);
        hdr->femecnt =  GET_RESP_INDEX(pck->hdr);

        hdr->fecerror  =        GET_FEC_ERROR(pck->hdr);
        hdr->synchfail =        GET_SYNCH_FAIL(pck->hdr);
        hdr->lostsynch =        GET_LOS_FLAG(pck->hdr);

        hdr->readmode = GET_RB_MODE(pck->args);
        hdr->compress = GET_RB_COMPRESS(pck->args);
        hdr->arg1     = GET_RB_ARG1(pck->args);
        hdr->arg2     = GET_RB_ARG2(pck->args);
        // To be independed from Fec_per_fem call it later
        //Arg12ToFecAsicChannel(Fec_Per_Fem, (unsigned short) GET_RB_ARG1(ntohs(pck->args)), (unsigned short) GET_RB_ARG2(ntohs(pck->args)), &fec, &asic, &channel);

        ts = (((int)(pck->ts_h))<<16) | (int) (pck->ts_l);

        hdr->evttype = GET_EVENT_TYPE(pck->ecnt);
        hdr->evttype =  GET_EVENT_COUNT(pck->ecnt);
        hdr->timestamp = ts;
        hdr->evttype =  pck->scnt;
        /*
          //scnt = ntohs(pck->scnt) & 0x7FF; // ?????

        // Compute the number of short words in the packet
        // Must subtract:
        // .  2 bytes for DCC header,
        // . 12 bytes for FEM header,
        // .  2 bytes used for storing the size field itself,
        // .  4 bytes used in the trailer for CRC32 or debug info 
        nbsw = (ntohs(pck->size) - 2 - 12 - 2 - 4) / sizeof(short);

        for (i=0;i<nbsw;i++)
        {
                samp = ntohs(pck->samp[i]);
                if (samp & ARGUMENT_FLAG)
                {
                        xil_printf("ArgRb (%3d)=0x%3x", i, GET_ARGUMENTS(samp));
                        Arg12ToFecAsicChannel(Fec_Per_Fem, (unsigned short) GET_RB_ARG1(samp), (unsigned short) GET_RB_ARG2(samp), &fec, &asic, &channel);
                        xil_printf(" (F:%d A:%d C:%d)\r\n", fec, asic, channel);
                }
                else if (samp & SAMPLE_COUNT_FLAG)
                {
                        xil_printf("SamCnt(%3d)=0x%3x (%4d)\r\n", i, GET_SAMPLE_COUNT(samp), GET_SAMPLE_COUNT(samp));
                }
                else if (samp & CELL_INDEX_FLAG)
                {
                        xil_printf("Cell  (%3d)=0x%3x (%4d)\r\n", i, GET_CELL_INDEX(samp), GET_CELL_INDEX(samp));
                }
                else
                {
                        xil_printf("Sample(%3d)=0x%3x (%4d)\r\n", i, samp, samp);
                }
        }
        tmp = (((unsigned int) ntohs(pck->samp[i])) << 16) | ((unsigned int) ntohs(pck->samp[i+1]));
        xil_printf("Trailer    =0x%08x (%d)\r\n", tmp, tmp);
        */
        //      printf("------------------------------------\r\n");
}

/*******************************************************************************
 DCC_Data_Decode 
*******************************************************************************/
static void DCC_Data_Decode(DataPacketV2 *pck, HarpoDccFrame *hdr)
{
        // DCC end of event packet
          hdr->size = pck->size;
          hdr->swversion =  ((DATA_PACKET_VER(pck->dcchdr)==0) ? 1 : 2);
          hdr->pkgtype   =      GET_FRAME_TY_V2(pck->dcchdr);
          hdr->dccindex  =      GET_DCC_INDEX(pck->dcchdr);
          hdr->femindex  =      GET_FEM_INDEX(pck->dcchdr);

        if (GET_FRAME_TY_V2(pck->dcchdr) & FRAME_FLAG_EOEV)
        {
          /* fem header ??? */

          return;
        }
        // DCC histogram packet
        else if (GET_TYPE(pck->hdr) == RESP_TYPE_HISTOGRAM)
        {
          /* fem header and arguments for histogram packet */
          hdr->msgtype =        GET_RESP_TYPE(pck->hdr);
          hdr->femecnt =        GET_RESP_INDEX(pck->hdr);
          hdr->fecerror  =      GET_FEC_ERROR(pck->hdr);
          hdr->synchfail =      GET_SYNCH_FAIL(pck->hdr);
          hdr->lostsynch =      GET_LOS_FLAG(pck->hdr);
          
          hdr->readmode = GET_RB_MODE(pck->args);
          hdr->compress =       GET_RB_COMPRESS(pck->args);
          hdr->arg1     =       GET_RB_ARG1(pck->args);
          hdr->arg2     = GET_RB_ARG2(pck->args);
          
          return;
        }
        
        else
        {
          printf("DCC_Data_Print: unknown frame type 0x%x\r\n",
                 GET_FRAME_TY_V2(pck->dcchdr));
        }
}

/*******************************************************************************
 DataPacketV2_Decode ONLY for DCC_DATA
*******************************************************************************/
/* include "pedestal_packet.h" */
static void DataPacketV2_Decode(DataPacketV2 *pck, HarpoDccFrame *hdr)
{
        hdr->size = pck->size;
        // DCC data packet has a different structure
        if (GET_FRAME_TY_V2(pck->dcchdr) & FRAME_TYPE_DCC_DATA)
        {
          DCC_Data_Decode(/* (EndOfEventPacket*) */ pck, hdr);
          return;
        }
        
        // FEM data - Pedestal Histogram Mathematics
        else if (GET_TYPE(pck->hdr) == RESP_TYPE_HISTOSTAT)
        {
          //Pedestal_PrintHistoMathPacket((PedestalHistoMathPacket *)pck);
          return;
        }

        // FEM data - Pedestal Histogram Bins
        else if (GET_TYPE(pck->hdr) == RESP_TYPE_HISTOGRAM)
        {
          //Pedestal_PrintHistoBinPacket((PedestalHistoBinPacket *) pck);
          return;
        }
        
        // FEM data - Pedestal Histogram Summary
        else if (GET_TYPE(pck->hdr) == RESP_TYPE_HISTOSUMMARY)
        {
          //    Pedestal_PrintHistoSummaryPacket((PedestalHistoSummaryPacket *)pck);
                return;
        }
        
        // FEM data - ADC samples in zero-suppressed or non zero-suppressed mode
        else if (GET_TYPE(pck->hdr) == RESP_TYPE_ADC_DATA)
        {
          FemAdcDataDecode(pck,hdr);
          return;
        }
}

/*******************************************************************************
 DataPacket_Decode 
*******************************************************************************/
Bool_t HarpoDccPacket::Decode(HarpoDccFrame &frm)
{
        PacketRxCommonHdr *h;
        Bool_t res = false;
        //      printf(" * pc pl %p %p \n",pc, pl); // %#lx
        if ( pc >= pl ) return res; // no more data
        while (pc < pl && *pc == 0 ) pc++ ; // skip padding word
        if ( pc >= pl ) return res; // no more data

        //      printf(" pc %hx %hx %hx %hx \n",*pc, *(pc+1) , *(pc+2), *(pc+3));

        h = (PacketRxCommonHdr *) pc;
        
        // Structure of packet has old and new version
        if (IS_DATA_PACKET_V2(h->hdr))
        {
          res = true ; // new v2 frame found
          //memset(&frm,0,sizeof(HarpoDccFrame));
          frm.reset();

          frm.dccHeader = pc; // Header @ current poit
          frm.dccData = pc;
          frm.dccData += 8;
          //size of DataPacketV2 == 4112 !!!!
          //      frm.dccData += (sizeof(DataPacketV2)/sizeof(UShort_t));
          frm.dccTrailer = pc;
          frm.dccTrailer += (h->size/sizeof(UShort_t) - 2);
          //      printf("sizeof %ld \n",sizeof(DataPacketV2));
          DataPacketV2_Decode((DataPacketV2*) h,&frm);
          //      printf(" ????????????? Decode %ul %ul %ul\n",
          //        frm.dccHeader,frm.dccData,frm.dccTrailer);
        }
        else
        {
          // Packet V1 not implemented
          //      DataPacketV1_Decode((DataPacketV1*) pck,&frm);
        }
        // Ajust current pointer
        pc += h->size / sizeof(UShort_t);
        //      printf(" ** pc pl %p %p \n",pc, pl); // %#lx
        return res;
}

HarpoDccPacket::HarpoDccPacket(UShort_t *pck, long blen)
{
  pbuf = pck;
  pc = pck;
  pl= pck;
  pl += (blen/sizeof(UShort_t) - 2) ; // last word pointers
}