DTuROSDigiToRaw.cc

Go to the documentation of this file.

//-------------------------------------------------
//
//   Class: DTuROSDigiToRaw
//
//   L1 DT uROS Raw-to-Digi
//
//
//
//   Author :
//   J. Troconiz  - UAM
//
//
//--------------------------------------------------

#include "EventFilter/DTRawToDigi/plugins/DTuROSDigiToRaw.h"
#include "FWCore/MessageLogger/interface/MessageLogger.h"
#include "CondFormats/DTObjects/interface/DTReadOutMapping.h"
#include "CondFormats/DataRecord/interface/DTReadOutMappingRcd.h"

#include "DataFormats/MuonDetId/interface/DTWireId.h"
#include "EventFilter/DTRawToDigi/interface/DTROChainCoding.h"
#include "EventFilter/Utilities/interface/DTCRC.h"

#include <iostream>


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

  produces<FEDRawDataCollection>();

  DTDigiInputTag_ = pset.getParameter<edm::InputTag>("DTDigi_Source");

  debug_ = pset.getUntrackedParameter<bool>("debug", false);

  for (int i=FEDNumbering::MINDTUROSFEDID; i<=FEDNumbering::MAXDTUROSFEDID; i++)
        feds_.push_back(i);
 
  nfeds_ = feds_.size();

  Raw_token = consumes<DTDigiCollection>(DTDigiInputTag_);

}


DTuROSDigiToRaw::~DTuROSDigiToRaw(){}


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

  FEDRawDataCollection data;

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

  auto fed_product = std::make_unique<FEDRawDataCollection>(data);

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

}


bool DTuROSDigiToRaw::fillRawData(edm::Event& e, const edm::EventSetup& c, FEDRawDataCollection& data) {

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

  edm::Handle<DTDigiCollection> digis;
  e.getByToken(Raw_token, digis);

  edm::ESHandle<DTReadOutMapping> mapping;
  c.get<DTReadOutMappingRcd>().get( mapping );

  for (int w_i = 0; w_i < nfeds_; ++w_i) {
    process(feds_[w_i], digis, mapping, data);
  }
  
  return true;
}


void DTuROSDigiToRaw::process(int DTuROSFED,
                              edm::Handle<DTDigiCollection> digis,
                              edm::ESHandle<DTReadOutMapping> mapping,
                              FEDRawDataCollection& data) {


  clear();


  //--> DTDigi analysis

  DTDigiCollection::DigiRangeIterator dttax;
  for (dttax = digis->begin(); dttax != digis->end(); ++dttax){
    const DTDigiCollection::Range& dttar = (*dttax).second;
    const DTLayerId dttal = (*dttax).first;
    for (DTDigiCollection::const_iterator ta = dttar.first; ta != dttar.second; ++ta) {

      int wheelId   = dttal.wheel();
      int sectorId  = dttal.sector();
      int stationId = dttal.station();
      int slId      = dttal.superlayer();
      int layerId   = dttal.layer();
      int cellId    = (*ta).wire();

      int dduId, rosId, robId, tdcId, tdcChannel;
      if ( ! mapping->geometryToReadOut(wheelId, stationId, sectorId, slId, layerId, cellId,
                    dduId, rosId, robId, tdcId, tdcChannel)) {

    int crate = theCRT(dduId, rosId);

    if (crate != DTuROSFED) continue;

    int slot  = theSLT(dduId, rosId, robId);
    int link  = theLNK(dduId, rosId, robId);

    int tdcTime   = (*ta).countsTDC();

    bslts[slot-1]++;

    int word = (      (link&0x7F)<<21)
             + (     (tdcId&0x03)<<19)
             + ((tdcChannel&0x1F)<<14)
             + (    tdcTime&0x3FFF   );

    wslts[slot-1].push_back(word);

      }
    }
  }


  int lines = 4;
  int nslts = 0;

  for (int sltit = 0; sltit < DOCESLOTS; sltit++) {

    if (bslts[sltit] == 0) continue;
    nslts += 1;
    lines += 1;

    dslts[sltit] = ((bslts[sltit]+1)/2)+5;
    lines += dslts[sltit];
  }

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

  int dataWord1, dataWord2;

  //--> Header

  dataWord1 = 0x50000000
             + (eventNum&0xFFFFFF);
  dataWord2 = (DTuROSFED&0xFFF)<<8;

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

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

  //--> AMC sizes

  dataWord1 = (nslts&0xF)<<20;
  dataWord2 = 0;

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

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

  for (int sltit = 0; sltit < DOCESLOTS; sltit++) {

    if (bslts[sltit] == 0) continue;

    dataWord1 = (dslts[sltit]&0xFFFFFF);
    dataWord2 = ((sltit+1)&0xF)<<16;

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

    lineFED+=4;
    *((int*)lineFED)=dataWord2; 
    lineFED+=4;
    *((int*)lineFED)=dataWord1; 
  }

  //--> AMC data

  for (int sltit = 0; sltit < DOCESLOTS; sltit++) {

    if (bslts[sltit] == 0) continue;

    dataWord1 = ((sltit+1)&0xF)<<24;
    dataWord2 = 0;

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

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

    dataWord1 = 0;
    dataWord2 = 0;

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

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

    for (int nhit = 0; nhit < bslts[sltit]/2; nhit++) {

      dataWord1 = 0x20000000
                + wslts[sltit].at(nhit*2);
      dataWord2 = wslts[sltit].at(nhit*2+1);

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

      lineFED+=4;
      *((int*)lineFED)=dataWord2; 
      lineFED+=4;
      *((int*)lineFED)=dataWord1; 
    }

    if (bslts[sltit]%2 == 1) {

      dataWord1 = 0x20000000
                + wslts[sltit].at(bslts[sltit]-1);
      dataWord2 = 0x1FFFFFFF;

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

      lineFED+=4;
      *((int*)lineFED)=dataWord2; 
      lineFED+=4;
      *((int*)lineFED)=dataWord1; 
    }

    dataWord1 = 0x40000000;
    dataWord2 = 0;

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

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

    dataWord1 = 0x40000000;
    dataWord2 = 0;

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

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

    dataWord1 = 0;
    dataWord2 = (dslts[sltit]&0xFFFFF);

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

    lineFED+=4;
    *((int*)lineFED)=dataWord2; 
    lineFED+=4;
    *((int*)lineFED)=dataWord1; 
  }

  //--> Trailer - line 1

  dataWord1 = 0;
  dataWord2 = 0;

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

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

  //--> Trailer - line 2

  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; 

  return;
}


void DTuROSDigiToRaw::clear() {

  for (int sltit = 0; sltit < DOCESLOTS; sltit++) {

    bslts[sltit]=0;
    dslts[sltit]=0;
    wslts[sltit].clear();
  }

  return;
}


int DTuROSDigiToRaw::theCRT(int ddu, int ros) {

  if (ros > 6 && ddu > 774) ddu = ddu - 5;
  
  if (ddu == 770) return FEDNumbering::MINDTUROSFEDID;
  else if (ddu == 771) return FEDNumbering::MINDTUROSFEDID;
  else if (ddu == 772) return FEDNumbering::MINDTUROSFEDID+1;
  return FEDNumbering::MAXDTUROSFEDID;
}


int DTuROSDigiToRaw::theSLT(int ddu, int ros, int rob) {

  if (ros > 6 && ddu > 774) ddu = ddu - 5;

  int slot = ((ros-1)/3)+1;
  if (rob == 23) slot = 5;
  if (ddu == 771) slot += 6;
  else if (ddu == 774) slot += 6;
  return slot;
}


int DTuROSDigiToRaw::theLNK(int ddu, int ros, int rob) {

  int link = rob;
  if (rob > 14) link = rob+1;
  if (rob == 24) link = 15;
  link += ((ros-1)%3)*24;
  if (rob == 23) link = ros-1;
  return link;
}


#include "FWCore/Framework/interface/MakerMacros.h"
DEFINE_FWK_MODULE(DTuROSDigiToRaw);