src/IGESConvGeom/IGESConvGeom_GeomBuilder.cxx

   1 // Copyright (c) 1999-2012 OPEN CASCADE SAS
   2 //
   3 // The content of this file is subject to the Open CASCADE Technology Public
   4 // License Version 6.5 (the "License"). You may not use the content of this file
   5 // except in compliance with the License. Please obtain a copy of the License
   6 // at http://www.opencascade.org and read it completely before using this file.
   7 //
   8 // The Initial Developer of the Original Code is Open CASCADE S.A.S., having its
   9 // main offices at: 1, place des Freres Montgolfier, 78280 Guyancourt, France.
  10 //
  11 // The Original Code and all software distributed under the License is
  12 // distributed on an "AS IS" basis, without warranty of any kind, and the
  13 // Initial Developer hereby disclaims all such warranties, including without
  14 // limitation, any warranties of merchantability, fitness for a particular
  15 // purpose or non-infringement. Please see the License for the specific terms
  16 // and conditions governing the rights and limitations under the License.
  17
  18 #include <IGESConvGeom_GeomBuilder.ixx>
  19 #include <TColStd_HArray1OfReal.hxx>
  20 #include <TColStd_HArray2OfReal.hxx>
  21 #include <Interface_Translates.hxx>
  22 #include <Standard_DomainError.hxx>
  23 #include <gp.hxx>
  24
  25
  26 static Standard_Real epsl = 1.E-10;
  27 static Standard_Real epsa = 1.E-10;
  28
  29     IGESConvGeom_GeomBuilder::IGESConvGeom_GeomBuilder ()
  30       {  Clear();  }
  31
  32
  33     void  IGESConvGeom_GeomBuilder::Clear ()
  34 {
  35   theXYZ = new TColgp_HSequenceOfXYZ();
  36   theVec = new TColgp_HSequenceOfXYZ();
  37   gp_Trsf trid;  thepos = trid;
  38 }
  39
  40     void  IGESConvGeom_GeomBuilder::AddXY  (const gp_XY&  val)
  41 {
  42   gp_XYZ aval (val.X(),val.Y(),0.);
  43   theXYZ->Append (aval);
  44   aval.SetCoord (0.,0.,0.);
  45   theVec->Append (aval);
  46 }
  47
  48     void  IGESConvGeom_GeomBuilder::AddXYZ (const gp_XYZ& val)
  49 {
  50   theXYZ->Append (val);
  51   theVec->Append (gp_XYZ(0.,0.,0.) );
  52 }
  53
  54     void  IGESConvGeom_GeomBuilder::AddVec (const gp_XYZ& val)
  55 {
  56   if (!theVec->IsEmpty()) theVec->SetValue (theVec->Length(), val);
  57 }
  58
  59     Standard_Integer  IGESConvGeom_GeomBuilder::NbPoints () const
  60 {  return theXYZ->Length();  }
  61
  62     gp_XYZ  IGESConvGeom_GeomBuilder::Point (const Standard_Integer num) const
  63 {  return theXYZ->Value (num);  }
  64
  65     Handle(IGESGeom_CopiousData)  IGESConvGeom_GeomBuilder::MakeCopiousData
  66   (const Standard_Integer datatype, const Standard_Boolean polyline) const
  67 {
  68   Standard_Integer num, nb = theXYZ->Length();
  69   if (datatype < 1 || datatype > 3 || nb == 0 || (polyline && datatype == 3))
  70     Standard_DomainError::Raise ("IGESConvGeom_GeomBuilder : MakeCopiousData");
  71
  72   Standard_Integer nbd = datatype+1;  // 1->2  2->3   et   3->6
  73   if (datatype == 3) nbd = 6;
  74   Handle(TColStd_HArray1OfReal) data = new TColStd_HArray1OfReal (1,nb*nbd);
  75   Standard_Real CZ = 0.;
  76   for (num = 1; num <= nb; num ++) {
  77     const gp_XYZ& pnt = theXYZ->Value(num);
  78     data->SetValue ((num-1)*nbd+1 , pnt.X());
  79     data->SetValue ((num-1)*nbd+2 , pnt.Y());
  80     if (datatype > 1) data->SetValue ((num-1)*nbd+3 , pnt.Z());
  81     else CZ += pnt.Z();
  82     if (datatype < 3) continue;
  83     const gp_XYZ& vec = theVec->Value(num);
  84     data->SetValue ((num-1)*nbd+4 , vec.X());
  85     data->SetValue ((num-1)*nbd+5 , vec.Y());
  86     data->SetValue ((num-1)*nbd+6 , vec.Z());
  87   }
  88   if (datatype == 1) CZ /= nb;
  89
  90   Handle(IGESGeom_CopiousData) res = new IGESGeom_CopiousData;
  91   res->Init (datatype,CZ,data);
  92   res->SetPolyline (polyline);
  93   return res;
  94 }
  95
  96     Handle(TColgp_HArray1OfXY)   IGESConvGeom_GeomBuilder::MakeXY  () const
  97 {
  98   Handle(TColgp_HArray1OfXY) res;
  99   Standard_Integer num, nb = theXYZ->Length();
 100   if (nb == 0) return res;
 101   res = new TColgp_HArray1OfXY (1,nb);
 102   for (num = 1; num <= nb; num ++) {
 103     const gp_XYZ& pnt = theXYZ->Value(num);
 104     res->SetValue (num , gp_XY (pnt.X(),pnt.Y()) );
 105   }
 106   return res;
 107 }
 108
 109     Handle(TColgp_HArray1OfXYZ)  IGESConvGeom_GeomBuilder::MakeXYZ () const
 110 {
 111   Handle(TColgp_HArray1OfXYZ) res;
 112 /*
 113   Standard_Integer num, nb = theXYZ->Length();
 114   if (nb == 0) return res;
 115   res = new TColgp_HArray1OfXYZ (1,nb);
 116   for (num = 1; num <= nb; num ++) {
 117     res->SetValue (num , theXYZ->Value(num) );
 118   }
 119 */
 120   SeqToArray(theXYZ,res,TColgp_HArray1OfXYZ);
 121   return res;
 122 }
 123
 124
 125     gp_Trsf  IGESConvGeom_GeomBuilder::Position () const
 126       {  return thepos;  }
 127
 128     void  IGESConvGeom_GeomBuilder::SetPosition (const gp_Trsf& pos)
 129       {  thepos = pos;  }
 130
 131     void  IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax3&  pos)
 132 {
 133   gp_Ax3 orig (gp::XOY());
 134   gp_Trsf ps;
 135   ps.SetTransformation (pos,orig);
 136   thepos = ps;
 137 }
 138
 139     void  IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax2&  pos)
 140 {
 141   gp_Ax3 a3(pos);
 142   SetPosition (a3);
 143 }
 144
 145     void  IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax1&  pos)
 146 {
 147   const gp_Pnt& p = pos.Location();
 148   const gp_Dir& d = pos.Direction();
 149   gp_Ax3 a3 (p,d);
 150   SetPosition (a3);
 151 }
 152
 153     Standard_Boolean  IGESConvGeom_GeomBuilder::IsIdentity () const
 154 {
 155   if (thepos.Form() == gp_Identity) return Standard_True;
 156 //   sinon, regarder de plus pres  ...
 157   if (!IsTranslation()) return Standard_False;
 158   if (!thepos.TranslationPart().IsEqual (gp_XYZ(0.,0.,0.),epsl) )
 159     return Standard_False;
 160   return Standard_True;
 161 }
 162
 163     Standard_Boolean  IGESConvGeom_GeomBuilder::IsTranslation () const
 164 {
 165   if (thepos.Form() == gp_Identity || thepos.Form() == gp_Translation)
 166     return Standard_True;
 167 //   sinon, regarder de plus pres  ...
 168
 169   Standard_Integer i,j;
 170   for (i = 1; i <= 3; i ++)
 171     for (j = 1; j <= 3; j ++) {
 172       Standard_Real cons = (i == j ? 1. : 0.);
 173       Standard_Real val  = thepos.Value(i,j);
 174       if (val > cons + epsa || val < cons - epsa) return Standard_False;
 175     }
 176   return Standard_True;
 177 }
 178
 179     Standard_Boolean  IGESConvGeom_GeomBuilder::IsZOnly () const
 180 {
 181   if (!IsTranslation()) return Standard_False;
 182   gp_XYZ t = thepos.TranslationPart();  t.SetZ (0.0);
 183   if (!t.IsEqual (gp_XYZ(0.,0.,0.),epsl) ) return Standard_False;
 184   return Standard_True;
 185 }
 186
 187     void  IGESConvGeom_GeomBuilder::EvalXYZ
 188   (const gp_XYZ& val,
 189    Standard_Real& X, Standard_Real& Y, Standard_Real& Z) const
 190 {
 191   val.Coord (X,Y,Z);
 192   thepos.Inverted().Transforms (X,Y,Z);
 193 }
 194
 195     Handle(IGESGeom_TransformationMatrix)
 196   IGESConvGeom_GeomBuilder::MakeTransformation (const Standard_Real unit) const
 197 {
 198   Handle(TColStd_HArray2OfReal) data = new TColStd_HArray2OfReal (1,3,1,4);
 199   Standard_Integer i,j;
 200   for (i = 1; i <= 3; i ++)
 201     for (j = 1; j <= 4; j ++)
 202       data->SetValue (i,j, (j == 4 ? thepos.Value(i,j)/unit : thepos.Value(i,j)) );
 203   Handle(IGESGeom_TransformationMatrix) rs = new IGESGeom_TransformationMatrix;
 204   rs->Init (data);
 205   if (thepos.IsNegative()) rs->SetFormNumber(1);
 206   return rs;
 207 }