#include "hfloatvec.h"
#include "hgeotube.h"

typedef HFloatVec FVec;

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

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

int HGeoTube::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 HGeoTube::writePoints(ofstream & fout, HGeoParam & ele) {
  fout<<ele.vol[0][0]<<"  "<<ele.vol[0][1]<<"  "<<ele.vol[0][2]<<'\n';
  fout<<ele.vol[1][0]<<"  "<<ele.vol[1][1]<<'\n';
  fout<<ele.vol[2][0]<<"  "<<ele.vol[2][1]<<"  "<<ele.vol[2][2]<<'\n';
  return HSUCCESS;
}