#include <TStyle.h>
#include <TROOT.h>
#include <TAxis.h>
#include <TF1.h>
#include <TFile.h>
#include <TH1.h>
#include <THn.h>
#include <TObjArray.h>
#include <TObject.h>
#include <TString.h>
#include <TVectorT.h>
#include <TCanvas.h>
#include <TProfile2D.h>
#include <TGraphErrors.h>
#include <TTreeStream.h>

#include <AliExternalTrackParam.h>
#include <AliTPCComposedCorrection.h>
#include <AliTPCCorrectionLookupTable.h>

#include <AliToyMCEventGenerator.h>

/*

.L $ALICE_ROOT/TPC/Upgrade/macros/AnaDelta.C+g


*/
TVectorD* MakeLogBinning(Int_t nbinsX, Double_t xmin, Double_t xmax);
TVectorD* MakeLinBinning(Int_t nbinsX, Double_t xmin, Double_t xmax);
TVectorD* MakeArbitraryBinning(const char* bins);

void DumpHn(THn *hn, TTreeSRedirector &stream);

void AnaDelta(TString file, TString outDir=".")
{
  //
  //
  //

  gStyle->SetOptFit();
  
  TTreeSRedirector stream(Form("%s/deltas.root",outDir.Data()));
  gROOT->cd();
  
  TFile f(file);
  THn *hn=(THn*)f.Get("hn");

  DumpHn(hn, stream);

  delete hn;
}


void AnaDeltaTree(TString file, TString outFile="deltas_tree.root")
{
  TFile f(file);
  gROOT->cd();
  TTree *t = (TTree*)f.Get("delta");
  Float_t soneOverPt=0.;
  Float_t radius=0.;
  Float_t trackPhi=0.;
  Float_t trackY=0.;
  Float_t trackZ=0.;
  Float_t resRphi=0.;
  Double_t trackRes=0.;
  Float_t pointY=0.;
  Float_t pointZ=0.;
  Short_t npTRD=0.;
  Short_t event=0.;
  
  t->SetBranchAddress("soneOverPt" , &soneOverPt);
  t->SetBranchAddress("r"          , &radius);
  t->SetBranchAddress("trackPhi"   , &trackPhi);
  t->SetBranchAddress("trackY"     , &trackY);
  t->SetBranchAddress("trackZ"     , &trackZ);
  t->SetBranchAddress("resRphi"    , &resRphi);
  t->SetBranchAddress("trackRes"   , &trackRes);
  t->SetBranchAddress("pointY"     , &pointY);
  t->SetBranchAddress("pointZ"     , &pointZ);
  t->SetBranchAddress("npTRD"      , &npTRD);
  t->SetBranchAddress("event"      , &event);
  
  // make binning
  TVectorD *vR   = MakeLinBinning(10,86.,250.);
  TVectorD *vPhi = MakeLinBinning(18*8,0.,2*TMath::Pi());
  TVectorD *vZ   = MakeLinBinning(50,-250.,250.);

  const Int_t nbins=4;
  Int_t bins[nbins]    = {vR->GetNrows()-1, vPhi->GetNrows()-1, vZ->GetNrows()-1, 80};
//   Int_t bins[nbins]    = {16, 18*5, 50, 80};
  Double_t xmin[nbins] = {86. , 0.,           -250., -2.};
  Double_t xmax[nbins] = {250., 2*TMath::Pi(), 250.,  2.};
  THnF *hn = new THnF("hn", "hn", nbins, bins, xmin, xmax);

  hn->GetAxis(0)->Set(vR  ->GetNrows()-1, vR  ->GetMatrixArray());
  hn->GetAxis(1)->Set(vPhi->GetNrows()-1, vPhi->GetMatrixArray());
  hn->GetAxis(2)->Set(vZ  ->GetNrows()-1, vZ  ->GetMatrixArray());
  
  
  for (Int_t iev=0; iev<t->GetEntries(); ++iev) {
    t->GetEntry(iev);
    
    // cuts
    // -- on trd
    if (npTRD<2) continue;
    Double_t pt=1./TMath::Abs(soneOverPt);
    if (pt<0.8) continue;
    
    Float_t resRphiRandom = resRphi*trackRes;
    Float_t deviation     = trackY+resRphiRandom-pointY;
    
    Double_t xx[4]={radius, trackPhi, trackZ ,deviation};
    hn->Fill(xx);
  }
  
  // do fits and fill tree
  TTreeSRedirector stream(outFile.Data());
  gROOT->cd();

  DumpHn(hn, stream);

  stream.GetFile()->cd();
  hn->Write();
  
  delete hn;
  delete vR;
  delete vPhi;
  delete vZ;
}


void AnaDeltaTree2(TString file/*, TString outDir="."*/)
{
  //
  // NOTE: not finished
  //
  TFile f(file);
  gROOT->cd();
  TTree *t = (TTree*)f.Get("delta");
  Float_t soneOverPt=0.;
  Float_t radius=0.;
  Float_t trackPhi=0.;
  Float_t trackY=0.;
  Float_t trackZ=0.;
  Float_t resRphi=0.;
  Float_t trackRes=0.;
  Float_t pointY=0.;
  Float_t pointZ=0.;
  Float_t npTRD=0.;
  Float_t event=0.;
  
  t->SetBranchAddress("soneOverPt" , &soneOverPt);
  t->SetBranchAddress("r"          , &radius);
  t->SetBranchAddress("trackPhi"   , &trackPhi);
  t->SetBranchAddress("trackY"     , &trackY);
  t->SetBranchAddress("trackZ"     , &trackZ);
  t->SetBranchAddress("resRphi"    , &resRphi);
  t->SetBranchAddress("trackRes"   , &trackRes);
  t->SetBranchAddress("pointY"     , &pointY);
  t->SetBranchAddress("pointZ"     , &pointZ);
  t->SetBranchAddress("npTRD"      , &npTRD);
  t->SetBranchAddress("event"      , &event);

  // make binning
  TVectorD *vZ   = MakeLinBinning(50,-250.,250.);
  TVectorD *vPhi = MakeLinBinning(18*8,0.,TMath::Pi());
  TVectorD *vR   = MakeLinBinning(16,86.,250.);

  TObjArray arrZ(vZ->GetNrows()-1);
  arrZ.SetOwner();
  
  for (Int_t iev=0; iev<t->GetEntries(); ++iev) {
    t->GetEntry(iev);
    
    // cuts
    // -- on trd
    if (npTRD<2) continue;

    Float_t resRphiRandom=resRphi*trackRes;

    Int_t binZ   = TMath::BinarySearch(vZ->GetNrows(),vZ->GetMatrixArray(),(Double_t)trackZ);
    Int_t binPhi = TMath::BinarySearch(vPhi->GetNrows(),vPhi->GetMatrixArray(),(Double_t)trackPhi);
    Int_t binR   = TMath::BinarySearch(vR->GetNrows(),vR->GetMatrixArray(),(Double_t)radius);

    if (binZ<0)   binZ=0;
    if (binPhi<0) binPhi=0;
    if (binR<0)   binR=0;

    TObjArray *arrPhi=(TObjArray*)arrZ.UncheckedAt(binZ);
    if (!arrPhi) {
      arrPhi=new TObjArray(vPhi->GetNrows()-1);
      arrZ.AddAt(arrPhi,binZ);
    }

    TObjArray *arrR=(TObjArray*)arrPhi->UncheckedAt(binPhi);
    if (!arrR) {
      arrR=new TObjArray(vR->GetNrows()-1);
      arrPhi->AddAt(arrR,binPhi);
    }

    TH1S *h = (TH1S*)arrR->UncheckedAt(binR);
    if (!h) {
      h = new TH1S(Form("h_%02d_%02d_%d02",binZ, binPhi, binR),
                   Form("z,phi,r: %02d,%02d,%d02; #Delta r#phi (cm)",binZ, binPhi, binR),
                   80, -2., 2.);
      arrR->AddAt(h, binR);
    }

    h->Fill(trackY+resRphiRandom-pointY);
  }

  // do fits and fill tree
}

void AnaDeltaResiduals(TString fluctuationMap, TString averageMap, TString outFile="deltas_residuals.root")
{
  //
  //
  //

  TFile fFluct(fluctuationMap);
  AliTPCCorrectionLookupTable *corrFluct = (AliTPCCorrectionLookupTable*)fFluct.Get("map");
  fFluct.Close();
  
  TFile fAverage(averageMap);
  AliTPCCorrectionLookupTable *corrAverage = (AliTPCCorrectionLookupTable*)fAverage.Get("map");
  fAverage.Close();
  
  TObjArray *arrMaps = new TObjArray(2);
  arrMaps->Add(corrAverage); // correction with the average Map
  arrMaps->Add(corrFluct);   // distortion with the fluctuation Map
  
  // create the composed correction
  // if the weight are set to +1 and -1, the first map will be responsible for the distortions
  // The second map for the corrections
  // !!!!! In AliTPCComposedCorrection::GetDistortion MakeInverseIterator is called !!!!
  // for this reason we have to add the maps in the wrong order
  
  AliTPCComposedCorrection *residualDistortion = new AliTPCComposedCorrection(arrMaps, AliTPCComposedCorrection::kQueueResidual);
  Float_t dummy=0;
  TVectorD weights(2);
  weights(1)=+1.;
  weights(0)=-AliToyMCEventGenerator::GetSCScalingFactor(corrFluct, corrAverage,dummy);
  residualDistortion->SetWeights(&weights);

  TVectorD *vR   = MakeLinBinning(10,86.,250.);
  TVectorD *vPhi = MakeLinBinning(18*8,0.,2*TMath::Pi());
  TVectorD *vZ   = MakeLinBinning(50,-250.,250.);
  
  const Int_t nbins=4;
  Int_t bins[nbins]    = {vR->GetNrows()-1, vPhi->GetNrows()-1, vZ->GetNrows()-1, 80};
  //   Int_t bins[nbins]    = {16, 18*5, 50, 80};
  Double_t xmin[nbins] = {86. , 0.,           -250., -2.};
  Double_t xmax[nbins] = {250., 2*TMath::Pi(), 250.,  2.};
  THnF *hn = new THnF("hn", "hn", nbins, bins, xmin, xmax);
  
  hn->GetAxis(0)->Set(vR  ->GetNrows()-1, vR  ->GetMatrixArray());
  hn->GetAxis(1)->Set(vPhi->GetNrows()-1, vPhi->GetMatrixArray());
  hn->GetAxis(2)->Set(vZ  ->GetNrows()-1, vZ  ->GetMatrixArray());
  
  AliExternalTrackParam vv;
  
  for (Float_t iz=-245; iz<=245; iz+=1) {
    Short_t roc=(iz>=0)?0:18;
    for (Float_t ir=86; ir<250; ir+=1) {
      for (Float_t iphi=0; iphi<TMath::TwoPi(); iphi+=1*TMath::DegToRad()){
        Float_t x=ir*(Float_t)TMath::Cos(iphi);
        Float_t y=ir*(Float_t)TMath::Sin(iphi);
        Float_t x3[3]    = {x,y,iz};
        Float_t dx3[3]   = {0.,0.,0.};
        residualDistortion->GetDistortion(x3,roc,dx3);

        Double_t ddx3[3]={dx3[0], dx3[1], dx3[2]};
        vv.Global2LocalPosition(ddx3,iphi);

        Double_t xx[4]={ir, iphi, iz ,ddx3[1]};
        hn->Fill(xx);
        
      }
    }
  }

  TTreeSRedirector stream(outFile.Data());
  gROOT->cd();
  
  DumpHn(hn, stream);
  
  stream.GetFile()->cd();
  hn->Write();
  
  delete hn;
  delete vR;
  delete vPhi;
  delete vZ;
  
  delete residualDistortion;
}

void DumpHn(THn *hn, TTreeSRedirector &stream)
{
  TAxis *ar   = hn->GetAxis(0);
  TAxis *aphi = hn->GetAxis(1);
  TAxis *az   = hn->GetAxis(2);
  
  
  for (Int_t iz=0; iz<az->GetNbins(); ++iz) {
    az->SetRange(iz+1,iz+1);
    TObjArray arrFits;
    arrFits.SetName(Form("z_%02d",iz));
    arrFits.SetOwner();
    
    for (Int_t ir=0; ir<ar->GetNbins(); ++ir) {
      ar->SetRange(ir+1,ir+1);
      for (Int_t iphi=0; iphi<aphi->GetNbins(); ++iphi) {
        aphi->SetRange(iphi+1,iphi+1);
        
        TH1 *hProj = hn->Projection(3);
        if (hProj->GetEntries()<1) {
          delete hProj;
          continue;
        }
        
        TF1 fg("fg","gaus",-2,2);
        Double_t cr   = ar->GetBinCenter(ir+1);
        Double_t cphi = aphi->GetBinCenter(iphi+1);
        Double_t cz   = az->GetBinCenter(iz+1);
        hProj->SetNameTitle(Form("h_%02d_%02d_%02d",iz+1, iphi+1, ir+1),
                            Form("z,phi,r: %02d,%02d,%02d (%.2f, %.2f, %.2f)",iz+1,iphi+1,ir+1, cz, cphi, cr )
        );
        hProj->Fit(&fg,"QR");
        arrFits.Add(hProj);

        Double_t mean     = fg.GetParameter(1);
        Double_t meanErr  = fg.GetParError(1);
        Double_t sigma    = fg.GetParameter(2);
        Double_t sigmaErr = fg.GetParError(2);
        Int_t    entries  = hProj->GetEntries();
        Double_t chi2ndf  = fg.GetChisquare()/fg.GetNDF();

        stream << "d" <<
        "ir="        << ir       <<
        "iphi="      << iphi     <<
        "iz="        << iz       <<
        "cr="        << cr       <<
        "cphi="      << cphi     <<
        "cz="        << cz       <<
        "mean="      << mean     <<
        "meanErr="   << meanErr  <<
        "sigma="     << sigma    <<
        "sigmaErr="  << sigmaErr <<
        "entries="   << entries  <<
        "chi2ndf="   << chi2ndf  <<
        "\n";
      }
    }
    stream.GetFile()->cd();
    arrFits.Write(0x0,TObject::kSingleKey);
    gROOT->cd();
  }
  
}

//______________________________________________________________________________
TVectorD* MakeLogBinning(Int_t nbinsX, Double_t xmin, Double_t xmax)
{
  //
  // Make logarithmic binning
  // the user has to delete the array afterwards!!!
  //
  
  //check limits
  if (xmin<1e-20 || xmax<1e-20){
    printf("For Log binning xmin and xmax must be > 1e-20. Using linear binning instead!");
    return MakeLinBinning(nbinsX, xmin, xmax);
  }
  if (xmax<xmin){
    Double_t tmp=xmin;
    xmin=xmax;
    xmax=tmp;
  }
  TVectorD *binLim=new TVectorD(nbinsX+1);
  Double_t first=xmin;
  Double_t last=xmax;
  Double_t expMax=TMath::Log(last/first);
  for (Int_t i=0; i<nbinsX+1; ++i){
    (*binLim)[i]=first*TMath::Exp(expMax/nbinsX*(Double_t)i);
  }
  return binLim;
}

//______________________________________________________________________________
TVectorD* MakeLinBinning(Int_t nbinsX, Double_t xmin, Double_t xmax)
{
  //
  // Make linear binning
  // the user has to delete the array afterwards!!!
  //
  if (xmax<xmin){
    Double_t tmp=xmin;
    xmin=xmax;
    xmax=tmp;
  }
  TVectorD *binLim=new TVectorD(nbinsX+1);
  Double_t first=xmin;
  Double_t last=xmax;
  Double_t binWidth=(last-first)/nbinsX;
  for (Int_t i=0; i<nbinsX+1; ++i){
    (*binLim)[i]=first+binWidth*(Double_t)i;
  }
  return binLim;
}

//_____________________________________________________________________________
TVectorD* MakeArbitraryBinning(const char* bins)
{
  //
  // Make arbitrary binning, bins separated by a ','
  //
  TString limits(bins);
  if (limits.IsNull()){
    printf("Bin Limit string is empty, cannot add the variable");
    return 0x0;
  }
  
  TObjArray *arr=limits.Tokenize(",");
  Int_t nLimits=arr->GetEntries();
  if (nLimits<2){
    printf("Need at leas 2 bin limits, cannot add the variable");
    delete arr;
    return 0x0;
  }
  
  TVectorD *binLimits=new TVectorD(nLimits);
  for (Int_t iLim=0; iLim<nLimits; ++iLim){
    (*binLimits)[iLim]=(static_cast<TObjString*>(arr->At(iLim)))->GetString().Atof();
  }
  
  delete arr;
  return binLimits;
}

void PlotFromTree(TTree *d, TString outDir=".")
{
  TCanvas *c=new TCanvas;
  gStyle->SetOptStat(0);
  d->SetMarkerStyle(20);
  d->SetMarkerSize(1);
  
  TProfile2D pRZ("pRZ",";z (cm); r(cm)",50,-250,250,10,85,250);
  d->Draw("entries:cr:cz>>pRZ","","profcolz");
  pRZ.GetZaxis()->UnZoom();
  c->SaveAs(Form("%s/entries_average.png",outDir.Data()));
  d->Draw("entries:cr:cz>>pRZ","iphi==2","profcolz");
  c->SaveAs(Form("%s/entries_onePhi.png",outDir.Data()));
  
  pRZ.SetMaximum(0.04);
  d->Draw("meanErr:cr:cz>>pRZ","","profcolz");
  c->SaveAs(Form("%s/meanErr_average.png",outDir.Data()));
  d->Draw("meanErr:cr:cz>>pRZ","iphi==2","profcolz");
  c->SaveAs(Form("%s/meanErr_onePhi.png",outDir.Data()));
  
  
  d->Draw("mean:cphi:cr","iz==25","colz");
  c->SaveAs(Form("%s/mean_oneZ_phi_allR.png",outDir.Data()));
  d->Draw("mean:meanErr:cphi","iz==25&&ir==2","goff");
  TGraphErrors *grmean_phi=new TGraphErrors(d->GetSelectedRows(),d->GetV3(),d->GetV1(),0,d->GetV2());
  grmean_phi->SetTitle(";#varphi;#LT#Delta r#varphi#GT");
  grmean_phi->SetMarkerStyle(20);
  grmean_phi->SetMarkerSize(1);
  grmean_phi->Draw("ap");
  c->SaveAs(Form("%s/mean_oneZ_phi_oneR.png",outDir.Data()));
  
  d->Draw("mean:cr:cphi","iz==25","colz");
  c->SaveAs(Form("%s/mean_oneZ_r_allPhi.png",outDir.Data()));
  
  d->Draw("mean:meanErr:cr","iz==25&&iphi==2","goff");
  TGraphErrors *grmean_r=new TGraphErrors(d->GetSelectedRows(),d->GetV3(),d->GetV1(),0,d->GetV2());
  grmean_r->SetTitle(";r (cm);#LT#Delta r#varphi#GT");
  grmean_r->SetMarkerStyle(20);
  grmean_r->SetMarkerSize(1);
  grmean_r->Draw("ap");
  c->SaveAs(Form("%s/mean_oneZ_r_onePhi.png",outDir.Data()));
  
  
  d->Draw("meanErr:cphi:cr","iz==25","colz");
  c->SaveAs(Form("%s/meanErr_oneZ_phi_allR.png",outDir.Data()));
  d->Draw("meanErr:cphi","iz==25&&ir==2");
  c->SaveAs(Form("%s/meanErr_oneZ_phi_oneR.png",outDir.Data()));
  
  d->Draw("meanErr:cr:cphi","iz==25","colz");
  c->SaveAs(Form("%s/meanErr_oneZ_r_allPhi.png",outDir.Data()));
  
  d->Draw("meanErr:cr","iz==25&&iphi==2");
  c->SaveAs(Form("%s/meanErr_oneZ_r_onePhi.png",outDir.Data()));
  
}