#include <vector>
#include <iostream>
#include <fstream>
#include <exception>
#include "TVector2.h"
#include "TpcAbsPadShape.h"
#include "TpcPadShapePool.h"
#include "TpcPad.h"
#include "TpcPadPlane.h"
#include "TpcGem.h"


void
createHexPadPlane(){
  double ar=0.2; // hexagone radius
  double a=ar*1.5;
  double b=ar*sqrt(3.); // y-grid distance

  double outerR=42.-0.4;
  double innerR=15.2;
  double phislice=5.0*TMath::Pi()/180;

  int nrows=2*floor(outerR/b);
  int ncols=2*floor(outerR/a);

  double startx=-outerR;
  double starty=startx;

  int nrings=7;
  int nslices=32;

  double dring=(outerR-innerR)/(double)nrings;

  try{

  TpcGem* _gem=new TpcGem(5000,           // Gain
			  0.02);          // Spread
  
  TpcPadShapePool* _padShapes = new TpcPadShapePool("Hexagons0.2.dat",
				   *_gem,
				   0.4, // lookup range
				   0.02, // Lookup Step
				   0.01); // LookupIntegrationStep

  TpcAbsPadShape* shape=_padShapes->GetPadShape(0);

  
  TpcPadPlane plane(50,50,2,2,-50,-50);

  

  int count=0;
  for(int i=0; i<ncols; ++i){
    double x=startx+a*(double)i;
    double yoff= (i%2==0) ? 0 : b/2.;
    for(int j=0; j<nrows; ++j){
      double y=starty+yoff+b*(double)j;
      
      double r=sqrt(x*x+y*y);
      TVector2 l(x,y);
      double phi=l.Phi();

      if(r>outerR)continue;
      if(r<innerR)continue;
      if(fabs(phi-TMath::Pi()/2)<phislice)continue;
      if(fabs(phi-3*TMath::Pi()/2)<phislice)continue;

      unsigned int sliceId=(unsigned int)floor(nslices*phi/TMath::Pi()/2);
      unsigned int ringId=(unsigned int)floor((r-innerR)/dring);

      unsigned int sectorId=sliceId*nrings+ringId;

      TpcPad* pad=new TpcPad(x,y,0,
			     shape, sectorId, count++);

      plane.AddPad(pad);
      
    }
  }

  // build neighbourhoods!
  unsigned int npads=plane.GetNPads();

  std::cout<<npads<<" pads created. Building neighbourhoods..."<<std::endl;
  std::cout.flush();

  for(int k=0;k<npads;++k){
    TpcPad* pad=plane.GetPad(k);
    std::vector<TpcPad*> neighblist;
    plane.GetPadList(pad->x(),pad->y(),ar*1.01,neighblist);
    unsigned int nneigh=neighblist.size();
    unsigned int c=0;
    for(int ineigh=0;ineigh<nneigh;++ineigh){
      if(neighblist[ineigh]->sectorId()==pad->sectorId() &&
	 neighblist[ineigh]->padId()!=pad->padId()){
	pad->addNeighbour(neighblist[ineigh]->id());
	++c;
      }
    }
    //std::cout<<"found "<<c<<" neighbours"<<std::endl;
    neighblist.clear();
  }

 ofstream outfile("hexplane.dat");
 plane.WriteToStream(outfile);
 outfile.close();


  }
  catch(std::exception& ex) {
    std::cout<< ex.what() <<std::endl;
    throw ex;
  }
}