#include "hvector.h"
#include "hgeopgon.h"

typedef HVector<float> FVec;

int HGeoPgon::readPoints(HGeoInfo & geoInfo, HString & volName, HGeoParam & ele) {
#ifdef WITHORACLE
  ele.vol=FVec(0.0F,3);
  char* vName=volName;
  int np=geoInfo.geoDb->getNr3DPoints(vName);
  ele.vol[0][0]=float(np);
  for(int i=0;i<np;i++) {
    if (geoInfo.geoDb->get3DPoint(vName,i+1,ele.vol[i+1])==HFAILURE) return HFAILURE;
  }
#endif
  return HSUCCESS;
}


int HGeoPgon::readPoints(HGeoInfo & geoInfo, HGeoParam & ele) {
  int n;
  geoInfo.fin >> n;
  ele.vol=FVec(0.0F,3);
  ele.vol[0][0]=float(n);
  if (n>ele.vol.length()-2) {
    cerr << "number of planes in pgon too large" << endl;
    return HFAILURE;
  }
  for(int i=1;i<=n+1;i++) {geoInfo.fin >> ele.vol[i];}
  return HSUCCESS;
}

void HGeoPgon::calcShape(HGeoParam & ele, HGeoShapePar & p) {
  p.noPar=4+3*(int(ele.vol[0][0]));
  p.volPar=ele.vol[1];
  p.volPar.append(FVec(ele.vol[0][0],1));
  int n=int(p.volPar[3])+1;
  for(int i=2;i<=n;i++) {
    p.volPar.append(ele.vol[i]/10.F);
  }
  return; 
}

int HGeoPgon::posShape(HGeoParam & ele, HGeoParam & mo, HGeoShapePar & p) {
  if (ele.mother=="CAVE" || mo.shape=="PGON") {
    posInPgon(ele,mo,p);
    return HSUCCESS;
  }
  cerr << ele.shape << " in " << mo.shape << " is not yet implemeted" << endl;
  return HFAILURE;
}


void HGeoPgon::posInPgon(HGeoParam & ele, HGeoParam & mo, HGeoShapePar & p) {
  float phi, theta, fac=10.F;
  if (ele.rot[0]>0.9999F && ele.rot[8]>0.9999F) p.nRot=0;
  else {
    if (ele.rot[0]>0.9999F) phi=0.0F;
    else {
      phi=acos(ele.rot[0])*p.raddeg;
      if (ele.rot[1]>0.0F) phi=360.F - phi;
      cout << "************************************* phi: " << phi << endl;
    }
    if (ele.rot[8]>0.9999F) theta=0.0F;
    else theta=90.F - acos(ele.rot[8])*p.raddeg;
#ifdef WITHGEANT
    GSROTM(++p.geantRotNo,90.,phi,(90.+theta),(phi+90.),theta,(90.+phi));
#else
    ++p.geantRotNo;
#endif
    p.nRot=p.geantRotNo;
  }
  ele.geaPos=0.0F;
  p.pos=(ele.trans - mo.geaPos) /fac;
  return;
}