2012-08-09 16:03:55 +06:00
|
|
|
// Copyright (C) 2007-2012 CEA/DEN, EDF R&D, OPEN CASCADE
|
2009-02-17 10:27:49 +05:00
|
|
|
//
|
2012-08-09 16:03:55 +06:00
|
|
|
// Copyright (C) 2003-2007 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
|
|
|
|
// CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
|
2009-02-17 10:27:49 +05:00
|
|
|
//
|
2012-08-09 16:03:55 +06:00
|
|
|
// This library is free software; you can redistribute it and/or
|
|
|
|
// modify it under the terms of the GNU Lesser General Public
|
|
|
|
// License as published by the Free Software Foundation; either
|
|
|
|
// version 2.1 of the License.
|
2009-02-17 10:27:49 +05:00
|
|
|
//
|
2012-08-09 16:03:55 +06:00
|
|
|
// This library is distributed in the hope that it will be useful,
|
|
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
// Lesser General Public License for more details.
|
2009-02-17 10:27:49 +05:00
|
|
|
//
|
2012-08-09 16:03:55 +06:00
|
|
|
// You should have received a copy of the GNU Lesser General Public
|
|
|
|
// License along with this library; if not, write to the Free Software
|
|
|
|
// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
2009-02-17 10:27:49 +05:00
|
|
|
//
|
2012-08-09 16:03:55 +06:00
|
|
|
// See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
|
2009-02-17 10:27:49 +05:00
|
|
|
//
|
2012-08-09 16:03:55 +06:00
|
|
|
|
2004-12-01 15:48:31 +05:00
|
|
|
#include <stdio.h>
|
2012-08-09 16:03:55 +06:00
|
|
|
#include <limits>
|
2004-12-01 15:48:31 +05:00
|
|
|
|
|
|
|
#include "DriverSTL_W_SMDS_Mesh.h"
|
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
#include "SMDS_FaceOfNodes.hxx"
|
|
|
|
#include "SMDS_IteratorOnIterators.hxx"
|
2004-12-01 15:48:31 +05:00
|
|
|
#include "SMDS_Mesh.hxx"
|
|
|
|
#include "SMDS_MeshElement.hxx"
|
|
|
|
#include "SMDS_MeshNode.hxx"
|
2012-08-09 16:03:55 +06:00
|
|
|
#include "SMDS_SetIterator.hxx"
|
|
|
|
#include "SMDS_VolumeTool.hxx"
|
|
|
|
#include "SMESH_TypeDefs.hxx"
|
|
|
|
|
2004-12-01 15:48:31 +05:00
|
|
|
#include <OSD_File.hxx>
|
2012-08-09 16:03:55 +06:00
|
|
|
#include <OSD_Path.hxx>
|
2004-12-01 15:48:31 +05:00
|
|
|
#include <OSD_Protection.hxx>
|
|
|
|
#include <TCollection_AsciiString.hxx>
|
2012-08-09 16:03:55 +06:00
|
|
|
#include <gp_XYZ.hxx>
|
2012-12-13 17:41:29 +06:00
|
|
|
#include <Basics_Utils.hxx>
|
2004-12-01 15:48:31 +05:00
|
|
|
|
|
|
|
#include "utilities.h"
|
|
|
|
|
|
|
|
// definition des constantes
|
|
|
|
static const int LABEL_SIZE = 80;
|
|
|
|
|
|
|
|
DriverSTL_W_SMDS_Mesh::DriverSTL_W_SMDS_Mesh()
|
|
|
|
{
|
|
|
|
myIsAscii = false;
|
|
|
|
}
|
|
|
|
|
|
|
|
void DriverSTL_W_SMDS_Mesh::SetIsAscii( const bool theIsAscii )
|
|
|
|
{
|
|
|
|
myIsAscii = theIsAscii;
|
|
|
|
}
|
|
|
|
|
|
|
|
Driver_Mesh::Status DriverSTL_W_SMDS_Mesh::Perform()
|
|
|
|
{
|
2012-12-13 17:41:29 +06:00
|
|
|
Kernel_Utils::Localizer loc;
|
|
|
|
|
2004-12-01 15:48:31 +05:00
|
|
|
Status aResult = DRS_OK;
|
|
|
|
|
|
|
|
if ( !myMesh ) {
|
|
|
|
fprintf(stderr, ">> ERROR : Mesh is null \n");
|
|
|
|
return DRS_FAIL;
|
|
|
|
}
|
2012-08-09 16:03:55 +06:00
|
|
|
findVolumeTriangles();
|
2004-12-01 15:48:31 +05:00
|
|
|
if ( myIsAscii )
|
|
|
|
aResult = writeAscii();
|
|
|
|
else
|
|
|
|
aResult = writeBinary();
|
|
|
|
|
|
|
|
return aResult;
|
|
|
|
}
|
2012-08-09 16:03:55 +06:00
|
|
|
//================================================================================
|
|
|
|
/*!
|
|
|
|
* \brief Destructor deletes temporary faces
|
|
|
|
*/
|
|
|
|
//================================================================================
|
|
|
|
|
|
|
|
DriverSTL_W_SMDS_Mesh::~DriverSTL_W_SMDS_Mesh()
|
|
|
|
{
|
|
|
|
for ( unsigned i = 0; i < myVolumeTrias.size(); ++i )
|
|
|
|
delete myVolumeTrias[i];
|
|
|
|
}
|
|
|
|
|
|
|
|
//================================================================================
|
|
|
|
/*!
|
|
|
|
* \brief Finds free facets of volumes for which faces are missing in the mesh
|
|
|
|
*/
|
|
|
|
//================================================================================
|
|
|
|
|
|
|
|
void DriverSTL_W_SMDS_Mesh::findVolumeTriangles()
|
|
|
|
{
|
|
|
|
SMDS_VolumeTool myTool;
|
|
|
|
SMDS_VolumeIteratorPtr vIt = myMesh->volumesIterator();
|
|
|
|
while ( vIt->more() )
|
|
|
|
{
|
|
|
|
myTool.Set( vIt->next() );
|
|
|
|
for ( int iF = 0; iF < myTool.NbFaces(); ++iF )
|
|
|
|
if ( myTool.IsFreeFace( iF ))
|
|
|
|
{
|
|
|
|
const SMDS_MeshNode** n = myTool.GetFaceNodes(iF);
|
|
|
|
int nbN = myTool.NbFaceNodes(iF);
|
|
|
|
std::vector< const SMDS_MeshNode*> nodes( n, n+nbN );
|
|
|
|
if ( !myMesh->FindElement( nodes, SMDSAbs_Face, /*Nomedium=*/false))
|
|
|
|
{
|
|
|
|
int nbTria = nbN - 2;
|
|
|
|
for ( int iT = 0; iT < nbTria; ++iT )
|
|
|
|
{
|
|
|
|
myVolumeTrias.push_back( new SMDS_FaceOfNodes( n[0], n[1+iT], n[2+iT] ));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
//================================================================================
|
|
|
|
/*!
|
|
|
|
* \brief Return iterator on both faces in the mesh and on temporary faces
|
|
|
|
*/
|
|
|
|
//================================================================================
|
|
|
|
|
|
|
|
SMDS_ElemIteratorPtr DriverSTL_W_SMDS_Mesh::getFaces() const
|
|
|
|
{
|
|
|
|
SMDS_ElemIteratorPtr facesIter = myMesh->elementsIterator(SMDSAbs_Face);
|
|
|
|
SMDS_ElemIteratorPtr tmpTriaIter( new SMDS_ElementVectorIterator( myVolumeTrias.begin(),
|
|
|
|
myVolumeTrias.end()));
|
|
|
|
typedef std::vector< SMDS_ElemIteratorPtr > TElemIterVector;
|
|
|
|
TElemIterVector iters(2);
|
|
|
|
iters[0] = facesIter;
|
|
|
|
iters[1] = tmpTriaIter;
|
|
|
|
|
|
|
|
typedef SMDS_IteratorOnIterators<const SMDS_MeshElement *, TElemIterVector> TItersIter;
|
|
|
|
return SMDS_ElemIteratorPtr( new TItersIter( iters ));
|
|
|
|
}
|
2004-12-01 15:48:31 +05:00
|
|
|
|
|
|
|
// static methods
|
|
|
|
|
|
|
|
static void writeInteger( const Standard_Integer& theVal,
|
2012-08-09 16:03:55 +06:00
|
|
|
OSD_File& ofile )
|
2004-12-01 15:48:31 +05:00
|
|
|
{
|
|
|
|
union {
|
|
|
|
Standard_Integer i;
|
|
|
|
char c[4];
|
|
|
|
}u;
|
|
|
|
|
|
|
|
u.i = theVal;
|
|
|
|
|
|
|
|
Standard_Integer entier;
|
|
|
|
entier = u.c[0] & 0xFF;
|
|
|
|
entier |= (u.c[1] & 0xFF) << 0x08;
|
|
|
|
entier |= (u.c[2] & 0xFF) << 0x10;
|
|
|
|
entier |= (u.c[3] & 0xFF) << 0x18;
|
|
|
|
|
|
|
|
ofile.Write((char *)&entier,sizeof(u.c));
|
|
|
|
}
|
|
|
|
|
|
|
|
static void writeFloat ( const Standard_ShortReal& theVal,
|
2012-08-09 16:03:55 +06:00
|
|
|
OSD_File& ofile)
|
2004-12-01 15:48:31 +05:00
|
|
|
{
|
|
|
|
union {
|
|
|
|
Standard_ShortReal f;
|
|
|
|
char c[4];
|
|
|
|
}u;
|
|
|
|
|
|
|
|
u.f = theVal;
|
|
|
|
|
|
|
|
Standard_Integer entier;
|
|
|
|
|
|
|
|
entier = u.c[0] & 0xFF;
|
|
|
|
entier |= (u.c[1] & 0xFF) << 0x08;
|
|
|
|
entier |= (u.c[2] & 0xFF) << 0x10;
|
|
|
|
entier |= (u.c[3] & 0xFF) << 0x18;
|
|
|
|
|
|
|
|
ofile.Write((char *)&entier,sizeof(u.c));
|
|
|
|
}
|
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
static gp_XYZ getNormale( const SMDS_MeshNode* n1,
|
|
|
|
const SMDS_MeshNode* n2,
|
|
|
|
const SMDS_MeshNode* n3)
|
2004-12-01 15:48:31 +05:00
|
|
|
{
|
2012-08-09 16:03:55 +06:00
|
|
|
SMESH_TNodeXYZ xyz1( n1 );
|
|
|
|
SMESH_TNodeXYZ xyz2( n2 );
|
|
|
|
SMESH_TNodeXYZ xyz3( n3 );
|
|
|
|
gp_XYZ q1 = xyz2 - xyz1;
|
|
|
|
gp_XYZ q2 = xyz3 - xyz1;
|
|
|
|
gp_XYZ n = q1 ^ q2;
|
2004-12-01 15:48:31 +05:00
|
|
|
double len = n.Modulus();
|
2012-08-09 16:03:55 +06:00
|
|
|
if ( len > std::numeric_limits<double>::min() )
|
2004-12-01 15:48:31 +05:00
|
|
|
n /= len;
|
|
|
|
|
|
|
|
return n;
|
|
|
|
}
|
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
//================================================================================
|
|
|
|
/*!
|
|
|
|
* \brief Decompose a mesh face into triangles
|
|
|
|
* \retval int - number of triangles
|
|
|
|
*/
|
|
|
|
//================================================================================
|
|
|
|
|
|
|
|
static int getTriangles( const SMDS_MeshElement* face,
|
|
|
|
const SMDS_MeshNode** nodes)
|
|
|
|
{
|
|
|
|
// WARNING: implementation must be coherent with counting triangles in writeBinary()
|
|
|
|
int nbN = face->NbCornerNodes();
|
|
|
|
const int nbTria = nbN-2;
|
|
|
|
for ( int i = 0; nbN > 1; --nbN )
|
|
|
|
{
|
|
|
|
nodes[ i++ ] = face->GetNode( 0 );
|
|
|
|
nodes[ i++ ] = face->GetNode( nbN-2 );
|
|
|
|
nodes[ i++ ] = face->GetNode( nbN-1 );
|
|
|
|
}
|
|
|
|
return nbTria;
|
|
|
|
}
|
|
|
|
|
2004-12-01 15:48:31 +05:00
|
|
|
// private methods
|
|
|
|
|
|
|
|
Driver_Mesh::Status DriverSTL_W_SMDS_Mesh::writeAscii() const
|
|
|
|
{
|
|
|
|
Status aResult = DRS_OK;
|
|
|
|
TCollection_AsciiString aFileName( (char *)myFile.c_str() );
|
|
|
|
if ( aFileName.IsEmpty() ) {
|
|
|
|
fprintf(stderr, ">> ERREOR : invalid file name \n");
|
|
|
|
return DRS_FAIL;
|
|
|
|
}
|
|
|
|
|
|
|
|
OSD_File aFile = OSD_File(OSD_Path(aFileName));
|
|
|
|
aFile.Build(OSD_WriteOnly,OSD_Protection());
|
2012-08-09 16:03:55 +06:00
|
|
|
|
|
|
|
char sval[16];
|
2004-12-01 15:48:31 +05:00
|
|
|
TCollection_AsciiString buf = TCollection_AsciiString ("solid\n");
|
|
|
|
aFile.Write (buf,buf.Length());buf.Clear();
|
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
const SMDS_MeshNode* triaNodes[2048];
|
|
|
|
|
|
|
|
SMDS_ElemIteratorPtr itFaces = getFaces();
|
|
|
|
while ( itFaces->more() )
|
|
|
|
{
|
|
|
|
const SMDS_MeshElement* aFace = itFaces->next();
|
|
|
|
int nbTria = getTriangles( aFace, triaNodes );
|
2004-12-01 15:48:31 +05:00
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
for ( int iT = 0, iN = 0; iT < nbTria; ++iT )
|
|
|
|
{
|
|
|
|
gp_XYZ normale = getNormale( triaNodes[iN],
|
|
|
|
triaNodes[iN+1],
|
|
|
|
triaNodes[iN+2] );
|
2004-12-01 15:48:31 +05:00
|
|
|
|
|
|
|
buf += " facet normal ";
|
|
|
|
sprintf (sval,"% 12e",normale.X());
|
|
|
|
buf += sval;
|
|
|
|
buf += " ";
|
|
|
|
sprintf (sval,"% 12e",normale.Y());
|
|
|
|
buf += sval;
|
|
|
|
buf += " ";
|
|
|
|
sprintf (sval,"% 12e",normale.Z());
|
|
|
|
buf += sval;
|
|
|
|
buf += '\n';
|
|
|
|
aFile.Write (buf,buf.Length());buf.Clear();
|
|
|
|
buf += " outer loop\n";
|
|
|
|
aFile.Write (buf,buf.Length());buf.Clear();
|
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
for ( int jN = 0; jN < 3; ++jN, ++iN ) {
|
|
|
|
const SMDS_MeshNode* node = triaNodes[iN];
|
2004-12-01 15:48:31 +05:00
|
|
|
buf += " vertex ";
|
|
|
|
sprintf (sval,"% 12e",node->X());
|
|
|
|
buf += sval;
|
|
|
|
buf += " ";
|
|
|
|
sprintf (sval,"% 12e",node->Y());
|
|
|
|
buf += sval;
|
|
|
|
buf += " ";
|
|
|
|
sprintf (sval,"% 12e",node->Z());
|
|
|
|
buf += sval;
|
|
|
|
buf += '\n';
|
|
|
|
aFile.Write (buf,buf.Length());buf.Clear();
|
|
|
|
}
|
|
|
|
buf += " endloop\n";
|
|
|
|
aFile.Write (buf,buf.Length());buf.Clear();
|
|
|
|
buf += " endfacet\n";
|
|
|
|
aFile.Write (buf,buf.Length());buf.Clear();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
buf += "endsolid\n";
|
|
|
|
aFile.Write (buf,buf.Length());buf.Clear();
|
|
|
|
|
|
|
|
aFile.Close ();
|
|
|
|
|
|
|
|
return aResult;
|
|
|
|
}
|
|
|
|
|
|
|
|
Driver_Mesh::Status DriverSTL_W_SMDS_Mesh::writeBinary() const
|
|
|
|
{
|
|
|
|
Status aResult = DRS_OK;
|
|
|
|
TCollection_AsciiString aFileName( (char *)myFile.c_str() );
|
|
|
|
if ( aFileName.IsEmpty() ) {
|
|
|
|
fprintf(stderr, ">> ERREOR : invalid filename \n");
|
|
|
|
return DRS_FAIL;
|
|
|
|
}
|
|
|
|
|
|
|
|
OSD_File aFile = OSD_File(OSD_Path(aFileName));
|
|
|
|
aFile.Build(OSD_WriteOnly,OSD_Protection());
|
|
|
|
|
|
|
|
// we first count the number of triangles
|
2012-08-09 16:03:55 +06:00
|
|
|
// WARNING: counting triangles must be coherent with getTriangles()
|
|
|
|
int nbTri = 0;
|
|
|
|
const SMDS_MeshInfo& info = myMesh->GetMeshInfo();
|
|
|
|
nbTri += info.NbTriangles();
|
|
|
|
nbTri += info.NbQuadrangles() * 2;
|
|
|
|
nbTri += myVolumeTrias.size();
|
|
|
|
if ( info.NbPolygons() > 0 )
|
|
|
|
{
|
|
|
|
SMDS_FaceIteratorPtr itFaces = myMesh->facesIterator();
|
|
|
|
while ( itFaces->more() )
|
|
|
|
{
|
|
|
|
const SMDS_MeshElement* aFace = itFaces->next();
|
|
|
|
if ( aFace->IsPoly() )
|
|
|
|
nbTri += aFace->NbNodes() - 2;
|
|
|
|
}
|
2004-12-01 15:48:31 +05:00
|
|
|
}
|
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
// char sval[80]; -- avoid writing not initialized memory
|
|
|
|
TCollection_AsciiString sval(LABEL_SIZE-1,' ');
|
|
|
|
aFile.Write((Standard_Address)sval.ToCString(),LABEL_SIZE);
|
|
|
|
|
2004-12-01 15:48:31 +05:00
|
|
|
// write number of triangles
|
|
|
|
writeInteger(nbTri,aFile);
|
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
// Loop writing nodes
|
|
|
|
|
2004-12-01 15:48:31 +05:00
|
|
|
int dum=0;
|
2012-08-09 16:03:55 +06:00
|
|
|
|
|
|
|
const SMDS_MeshNode* triaNodes[2048];
|
|
|
|
|
|
|
|
SMDS_ElemIteratorPtr itFaces = getFaces();
|
|
|
|
while ( itFaces->more() )
|
|
|
|
{
|
|
|
|
const SMDS_MeshElement* aFace = itFaces->next();
|
|
|
|
int nbTria = getTriangles( aFace, triaNodes );
|
2004-12-01 15:48:31 +05:00
|
|
|
|
2012-08-09 16:03:55 +06:00
|
|
|
for ( int iT = 0, iN = 0; iT < nbTria; ++iT )
|
|
|
|
{
|
|
|
|
gp_XYZ normale = getNormale( triaNodes[iN],
|
|
|
|
triaNodes[iN+1],
|
|
|
|
triaNodes[iN+2] );
|
|
|
|
writeFloat(normale.X(),aFile);
|
|
|
|
writeFloat(normale.Y(),aFile);
|
|
|
|
writeFloat(normale.Z(),aFile);
|
|
|
|
|
|
|
|
for ( int jN = 0; jN < 3; ++jN, ++iN )
|
|
|
|
{
|
|
|
|
const SMDS_MeshNode* node = triaNodes[iN];
|
|
|
|
writeFloat(node->X(),aFile);
|
|
|
|
writeFloat(node->Y(),aFile);
|
|
|
|
writeFloat(node->Z(),aFile);
|
2004-12-01 15:48:31 +05:00
|
|
|
}
|
|
|
|
aFile.Write (&dum,2);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
aFile.Close ();
|
|
|
|
|
|
|
|
return aResult;
|
|
|
|
}
|