// ---------------------------------------------------------------------------------------
// -----                                                                             -----
// -----                           R3BLandUnpack                                     -----
// -----                           Version 0.1                                       -----
// -----         Adapted by M.I. Cherciu @ 01.2014 after Y.Gonzalez code             -----
// -----                                                                             -----
// ---------------------------------------------------------------------------------------

//ROOT headers
#include "TClonesArray.h"
#include "TH1F.h"
#include "TMath.h"
//Fair headers
#include "FairRootManager.h"
#include "FairRunOnline.h"
#include "FairLogger.h"

//Land headers
#include "R3BLandRawHit.h"
#include "R3BLandUnpack.h"


//R3BLandUnpack: Constructor
R3BLandUnpack::R3BLandUnpack(char *strCalDir,
                             Short_t type, Short_t subType,
                             Short_t procId,
                             Short_t subCrate, Short_t control)
: FairUnpack(type, subType, procId, subCrate, control),
fRawData(new TClonesArray("R3BLandRawHit")),
fNHits(0)
{
}



//Virtual R3BLandUnpack: Public method
R3BLandUnpack::~R3BLandUnpack()
{
  LOG(INFO) << "R3BLandUnpack: Delete instance" << FairLogger::endl;
  delete fRawData;
}



//Init: Public method
Bool_t R3BLandUnpack::Init()
{
  Register();
  return kTRUE;
}



//Register: Protected method
void R3BLandUnpack::Register()
{
//  LOG(DEBUG) << "Registering" << FairLogger::endl;
  LOG(INFO) << "Registering ..." << FairLogger::endl;
  FairRootManager *fMan = FairRootManager::Instance();
  if(! fMan) {
    return;
  }
  fMan->Register("LandRawHit", "Raw data from Land", fRawData, kTRUE);
}



//DoUnpack: Public method
Bool_t R3BLandUnpack::DoUnpack(Int_t *data, Int_t size)
{
  LOG(DEBUG) << "Unpacking" << FairLogger::endl;

  UInt_t l_i = 0;
  UInt_t size_n = size/2 - 1;
  
  if(size_n > 200) {
    return kFALSE;
  }
  
  
  while(l_i < size_n) {
    
    UInt_t *p1 = (UInt_t*) (data + l_i);
    UShort_t l_sam_id = (p1[0] & 0xf0000000) >> 28;   //identifies the sam
    UShort_t l_gtb_id = (p1[0] & 0x0f000000) >> 24;   //0 or 1, identifies which of the 2 cables of the sam
    UShort_t l_da_siz = (p1[0] & 0x000001ff);

    LOG(DEBUG) << "sam was " << l_sam_id << ",  gtb was " << l_gtb_id
    << ",  size " << l_da_siz << FairLogger::endl;

    l_i += 1;
    
    p1 = (UInt_t*) (data + l_i);
    
    for(Int_t i1 = 0; i1 < l_da_siz; i1+=2) {
      UShort_t tac_addr;
      UShort_t tac_ch;
      UShort_t cal;
      UShort_t cntrl_data;
      UShort_t tac_data;
      UShort_t qdc_data;
      tac_addr = (p1[i1] & 0xf8000000) >> 27;
      tac_ch = (p1[i1] & 0x07c00000) >> 22;
      cal = (p1[i1] & 0x003C0000) >> 18;
      cntrl_data = (p1[i1] & 0x0003f000) >> 12;
      tac_data = (p1[i1] & 0x00000fff);
      qdc_data = (p1[i1+1] & 0x00000fff);
      l_i += 2;
      
      if(0 == cal && 16 != tac_ch && tac_data > 900 && tac_data < 3100) {
        LOG(DEBUG) << "TAC ADDR IS " << tac_addr << FairLogger::endl;
        LOG(DEBUG) << "TAC CH IS " << tac_ch << FairLogger::endl;
        LOG(DEBUG) << "TAC Data IS " << tac_data << FairLogger::endl;
        LOG(DEBUG) << "QDC Data IS " << qdc_data << FairLogger::endl;
        new ((*fRawData)[fNHits]) R3BLandRawHit(tac_addr, tac_ch, cal, cntrl_data, tac_data, qdc_data);
        fNHits++;
      }
    }
  }
  

  LOG(DEBUG) << "R3BLandUnpack: Number of hits per event in LAND: " << fNHits << FairLogger::endl;
  return kTRUE;
}
 
//Reset: Public method
void R3BLandUnpack::Reset()
{
  LOG(DEBUG) << "Clearing Data Structure" << FairLogger::endl;
  fRawData->Clear();
  fNHits = 0;
}


ClassImp(R3BLandUnpack)