#include "toimanager.h"
#include "pexceptions.h"
#include "ctimer.h"
#include "map2toi.h"

////////////////////////////////////////////////////////////////////////
Map2TOI::Map2TOI(SphereHEALPix<r_8>& sph)
: mSph(sph)
{
 SetEquinox();
 SetCoorIn();
 SetCoorMap();
}

Map2TOI::~Map2TOI()
{
}

////////////////////////////////////////////////////////////////////////
void Map2TOI::init() {
  cout << "Map2TOI::init" << endl;
  declareInput("Coord1In");     // input  index 0
  declareInput("Coord2In");     // input  index 1
  declareOutput("Coord1Out");   // output index 0
  declareOutput("Coord2Out");   // output index 1
  declareOutput("BoloOut");     // output index 2
}

////////////////////////////////////////////////////////////////////////
void Map2TOI::run() {

if(mSph.NbPixels()<1) {
  cout<<"Map2TOI::Map2TOI() Bad number of pixels in sphere "<<mSph.NbPixels()<<endl;
  throw ParmError("Map2TOI::Map2TOI() - Bad number of pixels in sphere");
}

long snb = getMinIn();
long sne = getMaxIn();
if(snb>sne) {
  cout<<"Map2TOI::run() - Bad sample interval"<<snb<<" , "<<sne<<endl;
  throw ParmError("Map2TOI::run() - Bad sample interval");
}
if(!checkInputTOIIndex(0) || !checkInputTOIIndex(1)) {
  cout<<"Map2TOI::run() - Input TOI (Coord1In or Coord2In) not connected! "<<endl;
  throw ParmError("Map2TOI::run() Output TOI (Coord1In or Coord2In) not connected!");
}
bool connected_Coord1Out = checkOutputTOIIndex(0);
bool connected_Coord2Out = checkOutputTOIIndex(1);
if(!checkOutputTOIIndex(2)) {
  cout<<"Map2TOI::run() - Output TOI (BoloOut) not connected! "<<endl;
  throw ParmError("Map2TOI::run() Output TOI (BoloOut) not connected!");
}
if( !(mTypCoorIn&TypCoordEq || mTypCoorIn&TypCoordGal) ) {
  cout<<"Map2TOI::run() - CoordIn Coordinates not Eq or Gal! "<<endl;
  throw ParmError("Map2TOI::run() - CoordIn Coordinates not Eq or Gal!");
}
if( !(mTypCoorMap&TypCoordEq || mTypCoorMap&TypCoordGal) ) {
  cout<<"Map2TOI::run() - Sphere Coordinates not Eq or Gal! "<<endl;
  throw ParmError("Map2TOI::run() - Sphere Coordinates not Eq or Gal!");
}

//---------------------------------------------------------
try {

uint_4 mSnRead=0, mSnFilled=0;
double mjd = MJDfrYear(mActualYear);

for(int k=snb;k<=sne;k++) {

  int_8 flg = 0;
  double coord1 = getData(0,k);
  double coord2 = getData(1,k);
  double c1 = coord1, c2=coord2, bolo = -99999.;
  mSnRead++;

  // Convert CoordIn to Standard
  double phi=-1.,theta;
  CoordConvertToStd(mTypCoorIn,c1,c2);
  if(mTypCoorIn&TypCoordEq && mTypCoorMap&TypCoordGal) { // CIn=Eq  CMap=Gal
    EqtoGal(mjd,c1,c2,&c1,&c2);
    phi   = c1 * M_PI/180.;
  } else if(mTypCoorIn&TypCoordGal && mTypCoorMap&TypCoordEq) { // CIn=Gal CMap=Eq
    GaltoEq(mjd,c1,c2,&c1,&c2);
    phi   = c1 * M_PI/12.;
  } else if(mTypCoorMap&TypCoordGal) { // CIn=Gal CMap=Gal
    phi   = c1 * M_PI/180.;
  } else if(mTypCoorMap&TypCoordEq) { // CIn=Eq CMap=Eq
    phi   = c1 * M_PI/12.;
  }
  theta = (90.-c2) * M_PI/180.;
  if(phi<0.   || phi>=2*M_PI) flg=FlgToiOut;
  if(theta<0. || theta>=M_PI) flg=FlgToiOut;

  if(!flg) {
    bolo = mSph(theta,phi);
    mSnFilled++;
  }

  if(connected_Coord1Out) putData(0,k,coord1,flg);
  if(connected_Coord2Out) putData(1,k,coord2,flg);
  putData(2,k,bolo,flg);
}

cout<<"TOI2Map::run: Samples Read "<<mSnRead<<" Filled "<<mSnFilled<<endl;

//---------------------------------------------------------
} catch (PException & exc) {
  cout<<"Map2TOI: Catched Exception "<<(string)typeid(exc).name()
      <<"\n .... Msg= "<<exc.Msg()<<endl;
}

return;                                                                            
}