#include "geantdef.h"
#include "hfloatvec.h"
#include "hgeocone.h"


typedef HFloatVec FVec;

int HGeoCone::readPoints(HGeoInfo & geoInfo, HGeoParam & ele) {
  FVec x(0.0F,3);
  ele.vol.assign(x,nCorners);
  int k=0;
  for(int i=0;i<2;i++) {
    geoInfo.fin >> ele.vol[k];
    k++;
    geoInfo.fin >> ele.vol[k][0] >> ele.vol[k][1];
    k++;
  }
  return HSUCCESS;
}

void HGeoCone::calcShape(HGeoParam & ele, HGeoShapePar & p) {
  float fac=10.F;
  p.noPar=5;
  p.volPar=FVec(0.0F,5);
  p.volPar[0]=ele.vol[2].norm(ele.vol[0]) /fac /2.F;
  p.volPar[1]=ele.vol[1][0] /fac;  
  p.volPar[2]=ele.vol[1][1] /fac;  
  p.volPar[3]=ele.vol[3][0] /fac;  
  p.volPar[4]=ele.vol[3][1] /fac;  
  return; 
}

int HGeoCone::posShape(HGeoParam & ele, HGeoParam & mo, HGeoShapePar & p) {
  ele.geaPos[0]=0.0F;
  ele.geaPos[1]=0.0F;
  ele.geaPos[2]=(ele.vol[2][2] + ele.vol[0][2]) /2.F;
  ele.geaRot=cgRot;
  return posInMother(ele,mo,p);
}


int HGeoCone::writePoints(ofstream & fout, HGeoParam & ele) {
  int k=0;
  do {
    fout<<ele.vol[k][0]<<"  "<<ele.vol[k][1]<<"  "<<ele.vol[k][2]<<'\n';
    k++;
    fout<<ele.vol[k][0]<<"  "<<ele.vol[k][1]<<'\n';
    k++;
  } while(k<nCorners);
  return HSUCCESS;
}