DTTFFEDSim.cc

Go to the documentation of this file.

//-------------------------------------------------
//
//   Class: DTTFFEDSim
//
//   L1 DT Track Finder Digi-to-Raw
//
//
//
//   Author :
//   J. Troconiz  UAM Madrid
//
//--------------------------------------------------

#include "EventFilter/DTTFRawToDigi/interface/DTTFFEDSim.h"

#include "DataFormats/Common/interface/Handle.h"
#include "FWCore/Framework/interface/Event.h"

#include <DataFormats/FEDRawData/interface/FEDRawData.h>
#include "EventFilter/Utilities/interface/DTCRC.h"

#include <iostream>

using namespace std;

DTTFFEDSim::DTTFFEDSim(const edm::ParameterSet& pset) : eventNum(0) {

  produces<FEDRawDataCollection>();

  DTDigiInputTag = pset.getParameter<edm::InputTag>("DTDigi_Source");
  DTPHTFInputTag = pset.getParameter<edm::InputTag>("DTTracks_Source");

  ChPh_tok = consumes<L1MuDTChambPhContainer>(DTDigiInputTag);
  ChTh_tok = consumes<L1MuDTChambThContainer>(DTDigiInputTag);
  Trk_tok = consumes<L1MuDTTrackContainer>(DTPHTFInputTag);

}

DTTFFEDSim::~DTTFFEDSim(){}

void DTTFFEDSim::produce(edm::Event& e, const edm::EventSetup& c) {

  FEDRawDataCollection data;

  if (!fillRawData(e, data)) return;

  unique_ptr<FEDRawDataCollection> fed_product(new FEDRawDataCollection(data));

  e.put(std::move(fed_product));

}

bool DTTFFEDSim::fillRawData(edm::Event& e,
                             FEDRawDataCollection& data) {

  eventNum = e.id().event();

  int lines = 2;

  edm::Handle<L1MuDTChambPhContainer> phtrig;
  e.getByToken(ChPh_tok,phtrig);
  lines += phtrig->bxSize(-1, 1);

  edm::Handle<L1MuDTChambThContainer> thtrig;
  e.getByToken(ChTh_tok,thtrig);
  lines += thtrig->bxSize(-1, 1);

  edm::Handle<L1MuDTTrackContainer>   trtrig;
  e.getByToken(Trk_tok,trtrig);
  lines += trtrig->bxSize(-1, 1)*3;

  FEDRawData& dttfdata = data.FEDData(0x30C);
  dttfdata.resize(lines*8); // size in bytes
  unsigned char* LineFED=dttfdata.data();

  int* dataWord1 = new int;
  int* dataWord2 = new int;

  //--> Header

  *dataWord1 = 0x50000000
             + (eventNum&0xFFFFFF);
  *dataWord2 = 0x00030C00;

  int newCRC =  0xFFFF;
  dt_crc::calcCRC(*dataWord1, *dataWord2, newCRC);

  *((int*)LineFED)=*dataWord2; 
  LineFED+=4;
  *((int*)LineFED)=*dataWord1; 

  //--> DTTF data 

  int TS1Id[4], TS2Id[4];   // word identifier for TS #1,#2 for stations 
  TS1Id[0] = 0x0E;      
  TS2Id[0] = 0x1E;
  TS1Id[1] = 0x2E;
  TS2Id[1] = 0x3E;
  TS1Id[3] = 0x4E;
  TS2Id[3] = 0x5E;
  TS1Id[2] = 0x8FFF8;
  TS2Id[2] = 0x9FFF8;

  //Input
  L1MuDTChambPhContainer::Phi_iterator tsphi;

  for ( tsphi =  phtrig->getContainer()->begin();
        tsphi != phtrig->getContainer()->end();
        tsphi++ ) {
    if ( tsphi->code() != 7 ) {

      int wheelID   = tsphi->whNum()+1;
      if ( wheelID <= 0 ) wheelID -= 2;
      int stationID = tsphi->stNum()-1;
      int is2nd     = tsphi->Ts2Tag();

      int channelNr = channel(wheelID, tsphi->scNum(), tsphi->bxNum()-is2nd);
      if ( channelNr == 255 ) continue;
      int TSId = ( is2nd == 0 ) ? TS1Id[stationID] : TS2Id[stationID];

      *dataWord1 = ((channelNr&0xFF)<<24)
                 + 0x00FFFFFF;

      if ( stationID != 2 ){
        *dataWord2 = (             (TSId&0x0FF)<<24)
               + (~(tsphi->code()+1)&0x007)
               + (   (~tsphi->phiB()&0x3FF)<<3) 
               + (    (~tsphi->phi()&0xFFF)<<13);
      }
      else {
        *dataWord2 = (             (TSId&0xFFFFF)<<12) 
               + (~(tsphi->code()+1)&0x00007)
               + (    (~tsphi->phi()&0x00FFF)<<3);
      }

      dt_crc::calcCRC(*dataWord1, *dataWord2, newCRC);

      LineFED+=4;
      *((int*)LineFED)=*dataWord2; 
      LineFED+=4;
      *((int*)LineFED)=*dataWord1; 
    }
  }
  //Input

  //Input
  L1MuDTChambThContainer::The_iterator tsthe;

  for ( tsthe =  thtrig->getContainer()->begin();
        tsthe != thtrig->getContainer()->end();
        tsthe++ ) {

    int wheelTh  = tsthe->whNum();
    int sectorID = tsthe->scNum();

    int channelNr = channel(0, sectorID, tsthe->bxNum());
    if ( channelNr == 255 ) continue;
    int TSId = wheelTh+2;

    *dataWord1 = ((channelNr&0xFF)<<24)
               + 0x00FFFFFF;

    *dataWord2 = ((TSId&0x07)<<28)
               + 0x0FFFFFFF;

    int stationID = tsthe->stNum()-1;
    for ( int bti = 0; bti < 7; bti++ )
      if ( wheelTh == -2 || wheelTh == -1 || 
       ( wheelTh == 0 && (sectorID == 0 || sectorID == 3 || sectorID == 4 || sectorID == 7 || sectorID == 8 || sectorID == 11) ) )
    *dataWord2 -= (tsthe->position(bti)&0x1)<<(stationID*7+bti);
      else
    *dataWord2 -= (tsthe->position(6-bti)&0x1)<<(stationID*7+bti);

    dt_crc::calcCRC(*dataWord1, *dataWord2, newCRC);

    LineFED+=4;
    *((int*)LineFED)=*dataWord2; 
    LineFED+=4;
    *((int*)LineFED)=*dataWord1; 
  }
  //Input

  //Output
  L1MuDTTrackContainer::Trackiterator tstrk;

  for ( tstrk =  trtrig->getContainer()->begin();
        tstrk != trtrig->getContainer()->end();
        tstrk++ ) {

    int channelNr = channel(tstrk->whNum(), tstrk->scNum(), tstrk->bx());
    if ( channelNr == 255 ) continue;
    int TSId = ( tstrk->TrkTag() == 0 ) ? 0xAFFF : 0xBFFF;

    *dataWord1 = ((channelNr&0xFF)<<24)
               + 0x00FFFFFF;

    *dataWord2 = (           (TSId&0xFFFF)<<16)
           + ( tstrk->stNum(4)&0x0000F)
               + ((tstrk->stNum(3)&0x0000F)<<4)
               + ((tstrk->stNum(2)&0x0000F)<<8)
           + ((tstrk->stNum(1)&0x00003)<<12);

    dt_crc::calcCRC(*dataWord1, *dataWord2, newCRC);

    LineFED+=4;
    *((int*)LineFED)=*dataWord2; 
    LineFED+=4;
    *((int*)LineFED)=*dataWord1; 

    TSId = ( tstrk->TrkTag() == 0 ) ? 0xCFFE : 0xDFFE;

    *dataWord1 = ((channelNr&0xFF)<<24)
               + 0x00FFFFFF;

    *dataWord2 = (                    (TSId&0xFFFE)<<16)
           + ( ~tstrk->quality_packed()&0x0007)
               + (     (tstrk->phi_packed()&0x00FF)<<3)
               + ( (~tstrk->charge_packed()&0x0001)<<11)
           + (     (~tstrk->pt_packed()&0x001F)<<12);

    dt_crc::calcCRC(*dataWord1, *dataWord2, newCRC);

    LineFED+=4;
    *((int*)LineFED)=*dataWord2; 
    LineFED+=4;
    *((int*)LineFED)=*dataWord1; 

    channelNr = channel(0, tstrk->scNum(), tstrk->bx());
    if ( channelNr == 255 ) continue;
    TSId = (tstrk->whNum()+3)<<16;
    TSId += ( tstrk->whNum() < 0 ) ? 0x8FFFC : 0x7FFFC;

    *dataWord1 = ((channelNr&0xFF)<<24)
               + 0x00FFFFFF;

    *dataWord2 = (TSId&0xFFFFC)<<12;

    if ( tstrk->TrkTag() == 0 ) {
      *dataWord2 +=                            0x3F80
                 + (       tstrk->eta_packed()&0x003F)
                 + ((~tstrk->finehalo_packed()&0x0001)<<6);
    }
    else {
      *dataWord2 +=                            0x007F
                 + (     ( tstrk->eta_packed()&0x003F)<<7)
                 + ((~tstrk->finehalo_packed()&0x0001)<<13);
    }

    dt_crc::calcCRC(*dataWord1, *dataWord2, newCRC);

    LineFED+=4;
    *((int*)LineFED)=*dataWord2; 
    LineFED+=4;
    *((int*)LineFED)=*dataWord1; 
  }
  //Output

  //--> Trailer

  *dataWord1 = 0xA0000000
             + (lines&0xFFFFFF);
  *dataWord2 = 0;

  dt_crc::calcCRC(*dataWord1, *dataWord2&0xFFFF, newCRC);

  *dataWord2 += (newCRC&0xFFFF)<<16;

  LineFED+=4;
  *((int*)LineFED)=*dataWord2; 
  LineFED+=4;
  *((int*)LineFED)=*dataWord1; 

  delete dataWord1;
  delete dataWord2;
  return true;
}

int DTTFFEDSim::channel( int wheel, int sector,  int bx ){

  // wheel  :  -3 -2 -1 +1 +2 +3 <=> PHTF's : N2, N1, N0, P0, P1, P2
  //                           0 <=> ETTF  
  // sector :  0 -> 11
  // bx     : -1 -> +1

  int myChannel = 255;

  if ( abs(bx) > 1)               { return myChannel; }
  if ( sector < 0 || sector > 11) { return myChannel; }
  if ( abs(wheel) > 3)            { return myChannel; }

  myChannel = sector*21 + wheel*3 - bx + 10 ; 

  if (myChannel > 125) myChannel += 2;

  return myChannel;
}

int DTTFFEDSim::bxNr( int channel ){

  int myChannel = channel;

  if (myChannel > 127) myChannel -= 2;

  if (myChannel < 0 || myChannel > 251 ){ return -999; }

  int myBx = 1-(myChannel%3);

  return myBx;
}

int DTTFFEDSim::sector( int channel ){

  int myChannel = channel;

  if (myChannel > 127) myChannel -= 2;

  if (myChannel < 0 || myChannel > 251 ){ return -999; }

  return myChannel/21;
}

int DTTFFEDSim::wheel( int channel ){

  int myChannel = channel;

  if (myChannel > 127) myChannel -= 2;

  if (myChannel < 0 || myChannel > 251 ){ return -999; }

  int myWheel = ((myChannel%21)/3)-3;

  return myWheel;
}