src/IGESConvGeom/IGESConvGeom_GeomBuilder.cxx

   1 // Copyright (c) 1999-2014 OPEN CASCADE SAS
   2 //
   3 // This file is part of Open CASCADE Technology software library.
   4 //
   5 // This library is free software; you can redistribute it and/or modify it under
   6 // the terms of the GNU Lesser General Public License version 2.1 as published
   7 // by the Free Software Foundation, with special exception defined in the file
   8 // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
   9 // distribution for complete text of the license and disclaimer of any warranty.
  10 //
  11 // Alternatively, this file may be used under the terms of Open CASCADE
  12 // commercial license or contractual agreement.
  13
  14 #include <IGESConvGeom_GeomBuilder.ixx>
  15 #include <TColStd_HArray1OfReal.hxx>
  16 #include <TColStd_HArray2OfReal.hxx>
  17 #include <Interface_Translates.hxx>
  18 #include <Standard_DomainError.hxx>
  19 #include <gp.hxx>
  20
  21
  22 static Standard_Real epsl = 1.E-10;
  23 static Standard_Real epsa = 1.E-10;
  24
  25     IGESConvGeom_GeomBuilder::IGESConvGeom_GeomBuilder ()
  26       {  Clear();  }
  27
  28
  29     void  IGESConvGeom_GeomBuilder::Clear ()
  30 {
  31   theXYZ = new TColgp_HSequenceOfXYZ();
  32   theVec = new TColgp_HSequenceOfXYZ();
  33   gp_Trsf trid;  thepos = trid;
  34 }
  35
  36     void  IGESConvGeom_GeomBuilder::AddXY  (const gp_XY&  val)
  37 {
  38   gp_XYZ aval (val.X(),val.Y(),0.);
  39   theXYZ->Append (aval);
  40   aval.SetCoord (0.,0.,0.);
  41   theVec->Append (aval);
  42 }
  43
  44     void  IGESConvGeom_GeomBuilder::AddXYZ (const gp_XYZ& val)
  45 {
  46   theXYZ->Append (val);
  47   theVec->Append (gp_XYZ(0.,0.,0.) );
  48 }
  49
  50     void  IGESConvGeom_GeomBuilder::AddVec (const gp_XYZ& val)
  51 {
  52   if (!theVec->IsEmpty()) theVec->SetValue (theVec->Length(), val);
  53 }
  54
  55     Standard_Integer  IGESConvGeom_GeomBuilder::NbPoints () const
  56 {  return theXYZ->Length();  }
  57
  58     gp_XYZ  IGESConvGeom_GeomBuilder::Point (const Standard_Integer num) const
  59 {  return theXYZ->Value (num);  }
  60
  61     Handle(IGESGeom_CopiousData)  IGESConvGeom_GeomBuilder::MakeCopiousData
  62   (const Standard_Integer datatype, const Standard_Boolean polyline) const
  63 {
  64   Standard_Integer num, nb = theXYZ->Length();
  65   if (datatype < 1 || datatype > 3 || nb == 0 || (polyline && datatype == 3))
  66     Standard_DomainError::Raise ("IGESConvGeom_GeomBuilder : MakeCopiousData");
  67
  68   Standard_Integer nbd = datatype+1;  // 1->2  2->3   et   3->6
  69   if (datatype == 3) nbd = 6;
  70   Handle(TColStd_HArray1OfReal) data = new TColStd_HArray1OfReal (1,nb*nbd);
  71   Standard_Real CZ = 0.;
  72   for (num = 1; num <= nb; num ++) {
  73     const gp_XYZ& pnt = theXYZ->Value(num);
  74     data->SetValue ((num-1)*nbd+1 , pnt.X());
  75     data->SetValue ((num-1)*nbd+2 , pnt.Y());
  76     if (datatype > 1) data->SetValue ((num-1)*nbd+3 , pnt.Z());
  77     else CZ += pnt.Z();
  78     if (datatype < 3) continue;
  79     const gp_XYZ& vec = theVec->Value(num);
  80     data->SetValue ((num-1)*nbd+4 , vec.X());
  81     data->SetValue ((num-1)*nbd+5 , vec.Y());
  82     data->SetValue ((num-1)*nbd+6 , vec.Z());
  83   }
  84   if (datatype == 1) CZ /= nb;
  85
  86   Handle(IGESGeom_CopiousData) res = new IGESGeom_CopiousData;
  87   res->Init (datatype,CZ,data);
  88   res->SetPolyline (polyline);
  89   return res;
  90 }
  91
  92     gp_Trsf  IGESConvGeom_GeomBuilder::Position () const
  93       {  return thepos;  }
  94
  95     void  IGESConvGeom_GeomBuilder::SetPosition (const gp_Trsf& pos)
  96       {  thepos = pos;  }
  97
  98     void  IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax3&  pos)
  99 {
 100   gp_Ax3 orig (gp::XOY());
 101   gp_Trsf ps;
 102   ps.SetTransformation (pos,orig);
 103   thepos = ps;
 104 }
 105
 106     void  IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax2&  pos)
 107 {
 108   gp_Ax3 a3(pos);
 109   SetPosition (a3);
 110 }
 111
 112     void  IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax1&  pos)
 113 {
 114   const gp_Pnt& p = pos.Location();
 115   const gp_Dir& d = pos.Direction();
 116   gp_Ax3 a3 (p,d);
 117   SetPosition (a3);
 118 }
 119
 120     Standard_Boolean  IGESConvGeom_GeomBuilder::IsIdentity () const
 121 {
 122   if (thepos.Form() == gp_Identity) return Standard_True;
 123 //   sinon, regarder de plus pres  ...
 124   if (!IsTranslation()) return Standard_False;
 125   if (!thepos.TranslationPart().IsEqual (gp_XYZ(0.,0.,0.),epsl) )
 126     return Standard_False;
 127   return Standard_True;
 128 }
 129
 130     Standard_Boolean  IGESConvGeom_GeomBuilder::IsTranslation () const
 131 {
 132   if (thepos.Form() == gp_Identity || thepos.Form() == gp_Translation)
 133     return Standard_True;
 134 //   sinon, regarder de plus pres  ...
 135
 136   Standard_Integer i,j;
 137   for (i = 1; i <= 3; i ++)
 138     for (j = 1; j <= 3; j ++) {
 139       Standard_Real cons = (i == j ? 1. : 0.);
 140       Standard_Real val  = thepos.Value(i,j);
 141       if (val > cons + epsa || val < cons - epsa) return Standard_False;
 142     }
 143   return Standard_True;
 144 }
 145
 146     Standard_Boolean  IGESConvGeom_GeomBuilder::IsZOnly () const
 147 {
 148   if (!IsTranslation()) return Standard_False;
 149   gp_XYZ t = thepos.TranslationPart();  t.SetZ (0.0);
 150   if (!t.IsEqual (gp_XYZ(0.,0.,0.),epsl) ) return Standard_False;
 151   return Standard_True;
 152 }
 153
 154     void  IGESConvGeom_GeomBuilder::EvalXYZ
 155   (const gp_XYZ& val,
 156    Standard_Real& X, Standard_Real& Y, Standard_Real& Z) const
 157 {
 158   val.Coord (X,Y,Z);
 159   thepos.Inverted().Transforms (X,Y,Z);
 160 }
 161
 162     Handle(IGESGeom_TransformationMatrix)
 163   IGESConvGeom_GeomBuilder::MakeTransformation (const Standard_Real unit) const
 164 {
 165   Handle(TColStd_HArray2OfReal) data = new TColStd_HArray2OfReal (1,3,1,4);
 166   Standard_Integer i,j;
 167   for (i = 1; i <= 3; i ++)
 168     for (j = 1; j <= 4; j ++)
 169       data->SetValue (i,j, (j == 4 ? thepos.Value(i,j)/unit : thepos.Value(i,j)) );
 170   Handle(IGESGeom_TransformationMatrix) rs = new IGESGeom_TransformationMatrix;
 171   rs->Init (data);
 172   if (thepos.IsNegative()) rs->SetFormNumber(1);
 173   return rs;
 174 }