#include "hvector.h"
#include "hgeocone.h"

typedef HVector<float> FVec;

int HGeoCone::readPoints(HGeoInfo & geoInfo, HString & volName, HGeoParam & ele) {
#ifdef WITHORACLE
  ele.vol=FVec(0.0F,3);
  char* vName=volName;
// not yet implemeted !!!!!!!!
  cerr << "code for reading a CONE from database is not yet implemeted" << endl;
  return HFAILURE;
#endif
  return HSUCCESS;
}


int HGeoCone::readPoints(HGeoInfo & geoInfo, HGeoParam & ele) {
  ele.vol=FVec(0.0F,3);
  int k=0;
  for(int i=0;i<2;i++) {
    geoInfo.fin >> ele.vol[k++];
    geoInfo.fin >> ele.vol[k][0] >> ele.vol[k++][1];}
  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) {
  if (mo.shape=="PGON") {
    posInPgon(ele,mo,p);
    return HSUCCESS;
  }
  cerr << ele.shape << " in " << mo.shape << " is not yet implemeted" << endl;
  return HFAILURE;
}


void HGeoCone::posInPgon(HGeoParam & ele, HGeoParam & mo, HGeoShapePar & p) {
  float fac=10.F;  
  p.nRot=0;
  ele.geaPos[0]=0.0F;
  ele.geaPos[1]=0.0F;
  ele.geaPos[2]=ele.vol[0][2] + fac * p.volPar[0];
  p.pos=(ele.trans - mo.geaPos + ele.geaPos) / fac;
  return;
}