//-----------------------------------------------------------
// File and Version Information:
// $Id$
//
// Description:
//      Implementation of class TpcElectronicsTask
//      see TpcElectronicsTask.hh for details
//
// Environment:
//      Software developed for the PANDA Detector at FAIR.
//
// Author List:
//      Sebastian Neubert    TUM            (original author)
//
//
//-----------------------------------------------------------

// Panda Headers ----------------------

// This Class' Header ------------------
#include "TpcElectronicsTask.h"

// C/C++ Headers ----------------------
#include <algorithm>
#include <iostream>

#include "TGraph.h"
#include "TROOT.h"
#include "TSystem.h"
#include "TCanvas.h"
#include "TLine.h"
#include "TApplication.h"


// Collaborating Class Headers --------
#include "CbmRootManager.h"
#include "TClonesArray.h"
#include "TpcSignal.h"
#include "TpcSample.h"
#include "TpcDigi.h"
#include "TpcDigiAge.h"
#include "TpcFrontend.h"
#include "TpcSimplePSAStrategy.h"
#include "TpcDigitizationPolicy.h"
#include "TpcCRRCPulseshape.h"
#include "TpcPSAplot.h"

// Class Member definitions -----------


TpcElectronicsTask::TpcElectronicsTask()
  : CbmTask("TPC Electronics response"), _persistence(kFALSE),_adcthres(100),
    _adcmax(100000), _adcbits(10), _samplefreq(40), _t0(-60000), _timebits(30),
    _psathres(10), _tdiff(50), _tint(50), _tsig(0.01)
{
  _signalBranchName = "TpcSignal";
 }


TpcElectronicsTask::~TpcElectronicsTask()
{
  if(_frontend!=0)delete _frontend;
  if(_psa!=0)delete _psa;
}

InitStatus
TpcElectronicsTask::Init()
{
  //Get ROOT Manager
  CbmRootManager* ioman= CbmRootManager::Instance();

  if(ioman==0)
    {
      Error("TpcElectronicsTask::Init","RootManager not instantiated!");
      return kERROR;
    }
  
  // Get input collection
  _signalArray=(TClonesArray*) ioman->GetObject(_signalBranchName);
  
  if(_signalArray==0)
    {
      Error("TpcElectronicsTask::Init","Signal-array not found!");
      return kERROR;
    }
  
  // create and register output array
  _digiArray = new TClonesArray("TpcDigi"); 
  ioman->Register("TpcDigi","Tpc",_digiArray,_persistence);

  
  //TODO: Get this from Database!
  _frontend= new TpcFrontend(_adcthres,    // AdcThreshold
			     _adcmax, // adcmax
			     _adcbits,     // adcbits
			     _samplefreq,     // SamplingFreq_Mhz
			     _t0,      // t0
			     _timebits,     // timebits
			     _psathres);     // PSAthreshold

  _pulseshape= new TpcCRRCPulseshape(_tdiff,_tint,_tsig); // tdiff,tint,tsig

  _psa= new TpcSimplePSAStrategy(_psathres); // threshold (in adc channels)

  return kSUCCESS;
}


void
TpcElectronicsTask::Exec(Option_t* opt)
{
  std::cout<<"TpcElectronicsTask::Exec"<<std::endl;
  // Reset output Array
  if(_digiArray==0) Fatal("TpcElectronics::Exec)","No DigiArray");
  _digiArray->Delete();

  //partition data according to pads
  std::cout<<"Building up padmap ...";
  std::map<unsigned int,std::vector<TpcSignal*>* > padmap;
  Int_t ns=_signalArray->GetEntriesFast();
  for(Int_t is=0;is<ns;++is){
    TpcSignal* sig=(TpcSignal*)_signalArray->At(is);
    unsigned int id=sig->padId();
    if(padmap[id]==NULL)padmap[id]=new std::vector<TpcSignal*>;
    padmap[id]->push_back(sig);
  }
  std::cout<<"finished. "<<padmap.size()<<" pads hit"<<std::endl;
  // cleanup _signal_array;
  //_signalArray->Clear();

  // process each pad individually:
  std::map<unsigned int,std::vector<TpcSignal*>* >::iterator padIt=padmap.begin();
  int counter=0;
  while(padIt!=padmap.end()){
    if(counter++%5000==0){
      std::cout<<".";
      std::cout.flush();
    }
    // --- ADC ------------------------------------------
    std::vector<TpcSignal*>* sv=padIt->second;
    std::vector<TpcSample*> samplelist;
    TpcDigitizationPolicy().Digitize(sv,&samplelist,_frontend,_pulseshape);
    // cleanup signals
    int nsig=sv->size();
    //for(int isig=0; isig<nsig;++isig)delete(*sv)[isig];
	//    sv->clear();
    //std::cout<<samplelist.size()<<" samples created!"<<std::endl;

    // --- PSA ------------------------------------------
    std::vector<TpcDigi*> digis;

	_psa->Process(samplelist,digis);


    int nsamp=samplelist.size();
    int ndigi=digis.size();

	/*
	for(int i=0;i<digis.size();i++) {
	  std::cout << digis[i]->amp() << " " << digis[i]->t() << " " << digis[i]->padId() << std::endl;
	}
	



	for(int iSig=0;iSig<nsig;iSig++) {
	  std::cout << ((*sv)[iSig])->t() << " " 
				<< _frontend->ClockFine( ((*sv)[iSig])->t() ) 
				<< std::endl;
	}


	
	if(nsamp>0) {
	  TpcPSAplot myplot(&samplelist,&digis,sv,_frontend);
	  myplot.Draw();
	}
	*/
	  

    sv->clear();
    // cleanup samples

    for(int isamp=0;isamp<nsamp;++isamp)delete samplelist[isamp];
    samplelist.clear();

    //copy data into digi_array (TClonesvector)
	//    int ndigi=digis.size();
    int iarray=_digiArray->GetEntriesFast();
    for(int idigi=0;idigi<ndigi;++idigi) {
      new((*_digiArray)[iarray+idigi]) TpcDigi(*(digis[idigi]));
      delete digis[idigi]; // clean up temporay store
    }
    
    ++padIt;
  } // end loop over hit pads
  
  std::cout<<std::endl<<_digiArray->GetEntriesFast()<<" Digis created"<<std::endl;
  return;
}

ClassImp(TpcElectronicsTask)