492 lines
14 KiB
C++
492 lines
14 KiB
C++
/*
|
|
* This program source code file is part of KiCad, a free EDA CAD application.
|
|
*
|
|
* Copyright (C) 2013 Tuomas Vaherkoski <tuomasvaherkoski@gmail.com>
|
|
* Copyright (C) 1992-2013 KiCad Developers, see AUTHORS.txt for contributors.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This program 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 General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, you may find one here:
|
|
* http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
|
|
* or you may search the http://www.gnu.org website for the version 2 license,
|
|
* or you may write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
|
|
*/
|
|
|
|
/**
|
|
* @file x3dmodelparser.cpp
|
|
*/
|
|
|
|
#include <fctsys.h>
|
|
#include <macros.h>
|
|
#include <info3d_visu.h>
|
|
#include <wx/xml/xml.h>
|
|
#include <wx/tokenzr.h>
|
|
#include <wx/string.h>
|
|
#include <map>
|
|
#include <queue>
|
|
#include <vector>
|
|
|
|
#include "3d_struct.h"
|
|
#include "modelparsers.h"
|
|
|
|
X3D_MODEL_PARSER::X3D_MODEL_PARSER( S3D_MASTER* aMaster ) :
|
|
S3D_MODEL_PARSER( aMaster )
|
|
{}
|
|
|
|
|
|
X3D_MODEL_PARSER::~X3D_MODEL_PARSER()
|
|
{}
|
|
|
|
|
|
void X3D_MODEL_PARSER::Load( const wxString aFilename )
|
|
{
|
|
wxXmlDocument doc;
|
|
|
|
if( !doc.Load( aFilename ) )
|
|
{
|
|
wxLogError( wxT( "Error while parsing file <%s>" ), GetChars( aFilename ) );
|
|
return;
|
|
}
|
|
|
|
if( doc.GetRoot()->GetName() != wxT( "X3D" ) )
|
|
{
|
|
wxLogError( wxT( "Filetype is not X3D <%s>" ), GetChars( aFilename ) );
|
|
return;
|
|
}
|
|
|
|
// Shapes are inside of Transform nodes
|
|
// Transform node contains information about
|
|
// transition, scale and rotation of the shape
|
|
NODE_LIST transforms;
|
|
GetChildsByName( doc.GetRoot(), wxT( "Transform" ), transforms );
|
|
|
|
for( NODE_LIST::iterator node_it = transforms.begin();
|
|
node_it != transforms.end();
|
|
node_it++ )
|
|
{
|
|
readTransform( *node_it );
|
|
}
|
|
}
|
|
|
|
|
|
wxString X3D_MODEL_PARSER::VRML_representation()
|
|
{
|
|
wxString output;
|
|
|
|
for( unsigned i = 0; i < vrml_points.size(); i++ )
|
|
{
|
|
output += wxT( "Shape {\n"
|
|
" appearance Appearance {\n"
|
|
" material Material {\n" ) +
|
|
vrml_materials[i] +
|
|
wxT( " }\n"
|
|
" }\n"
|
|
" geometry IndexedFaceSet {\n"
|
|
" solid TRUE\n"
|
|
" coord Coordinate {\n"
|
|
" point [\n") +
|
|
vrml_points[i] +
|
|
wxT( " ]\n"
|
|
" }\n"
|
|
" coordIndex [\n" ) +
|
|
vrml_coord_indexes[i] +
|
|
wxT( " ]\n"
|
|
" }\n"
|
|
"},\n" );
|
|
}
|
|
|
|
return output;
|
|
}
|
|
|
|
|
|
void X3D_MODEL_PARSER::GetChildsByName( wxXmlNode* aParent,
|
|
const wxString aName,
|
|
std::vector< wxXmlNode* >& aResult )
|
|
{
|
|
// Breadth-first search (BFS)
|
|
std::queue< wxXmlNode* > found;
|
|
found.push( aParent );
|
|
|
|
while( !found.empty() )
|
|
{
|
|
wxXmlNode *elem = found.front();
|
|
|
|
for( wxXmlNode *child = elem->GetChildren();
|
|
child != NULL;
|
|
child = child->GetNext() )
|
|
{
|
|
if( child->GetName() == aName )
|
|
{
|
|
aResult.push_back( child );
|
|
}
|
|
|
|
found.push( child );
|
|
}
|
|
|
|
found.pop();
|
|
}
|
|
}
|
|
|
|
|
|
void X3D_MODEL_PARSER::GetNodeProperties( wxXmlNode* aNode, PROPERTY_MAP& aProps )
|
|
{
|
|
wxXmlProperty *prop;
|
|
|
|
for( prop = aNode->GetAttributes();
|
|
prop != NULL;
|
|
prop = prop->GetNext() )
|
|
{
|
|
aProps[ prop->GetName() ] = prop->GetValue();
|
|
}
|
|
}
|
|
|
|
/* Private ----- */
|
|
|
|
void X3D_MODEL_PARSER::readTransform( wxXmlNode* aTransformNode )
|
|
{
|
|
NODE_LIST childnodes;
|
|
GetChildsByName( aTransformNode, wxT( "Material" ), childnodes );
|
|
|
|
for( NODE_LIST::iterator node = childnodes.begin();
|
|
node != childnodes.end();
|
|
node++ )
|
|
{
|
|
readMaterial( *node );
|
|
}
|
|
|
|
childnodes.clear();
|
|
|
|
PROPERTY_MAP properties;
|
|
GetNodeProperties( aTransformNode, properties );
|
|
GetChildsByName( aTransformNode, wxT("IndexedFaceSet"), childnodes );
|
|
|
|
for( NODE_LIST::iterator node = childnodes.begin();
|
|
node != childnodes.end();
|
|
node++ )
|
|
{
|
|
readIndexedFaceSet( *node, properties );
|
|
}
|
|
|
|
childnodes.clear();
|
|
}
|
|
|
|
|
|
void X3D_MODEL_PARSER::readMaterial( wxXmlNode* aMatNode )
|
|
{
|
|
PROPERTY_MAP properties;
|
|
GetNodeProperties( aMatNode, properties );
|
|
|
|
// DEFine new Material named as value of DEF
|
|
if( properties.find( wxT( "DEF" ) ) != properties.end() )
|
|
{
|
|
double amb, shine, transp;
|
|
|
|
S3D_MATERIAL* material = new S3D_MATERIAL( GetMaster(), properties[ wxT( "DEF" ) ] );
|
|
GetMaster()->Insert( material );
|
|
|
|
if( !parseDoubleTriplet( properties[ wxT( "diffuseColor" ) ],
|
|
material->m_DiffuseColor ) )
|
|
{
|
|
D( printf("diffuseColor parsing error") );
|
|
}
|
|
|
|
if( !parseDoubleTriplet( properties[ wxT( "specularColor" ) ],
|
|
material->m_SpecularColor ) )
|
|
{
|
|
D( printf("specularColor parsing error") );
|
|
}
|
|
|
|
if( !parseDoubleTriplet( properties[ wxT( "emissiveColor" ) ],
|
|
material->m_EmissiveColor ) )
|
|
{
|
|
D( printf("emissiveColor parsing error") );
|
|
}
|
|
|
|
wxStringTokenizer values;
|
|
values.SetString( properties[ wxT( "ambientIntensity" ) ] );
|
|
|
|
if( values.GetNextToken().ToDouble( &amb ) )
|
|
{
|
|
material->m_AmbientIntensity = amb;
|
|
}
|
|
else
|
|
{
|
|
D( printf( "ambienterror" ) );
|
|
}
|
|
|
|
values.SetString( properties[ wxT( "shininess" ) ] );
|
|
|
|
if( values.GetNextToken().ToDouble( &shine ) )
|
|
{
|
|
material->m_Shininess = shine;
|
|
}
|
|
else
|
|
{
|
|
D( printf( "shininess error" ) );
|
|
}
|
|
|
|
values.SetString( properties[ wxT( "transparency" ) ] );
|
|
|
|
if( values.GetNextToken().ToDouble( &transp ) )
|
|
{
|
|
material->m_Transparency = transp;
|
|
}
|
|
else
|
|
{
|
|
D( printf( "trans error") );
|
|
}
|
|
|
|
material->SetMaterial();
|
|
|
|
// VRML
|
|
wxString vrml_material;
|
|
PROPERTY_MAP::const_iterator p = ++properties.begin(); // skip DEF
|
|
|
|
for(;p != properties.end();p++)
|
|
{
|
|
vrml_material.Append( p->first + wxT( " " ) + p->second + wxT( "\n" ) );
|
|
}
|
|
|
|
vrml_materials.push_back( vrml_material );
|
|
}
|
|
|
|
// USE existing material named by value of USE
|
|
else if( properties.find( wxT( "USE" ) ) != properties.end() )
|
|
{
|
|
S3D_MATERIAL* material = NULL;
|
|
wxString mat_name = properties[ wxT( "USE" ) ];
|
|
|
|
for( material = GetMaster()->m_Materials; material; material = material->Next() )
|
|
{
|
|
if( material->m_Name == mat_name )
|
|
{
|
|
|
|
wxString vrml_material;
|
|
vrml_material.Append( wxString::Format( wxT( "specularColor %f %f %f\n" ),
|
|
material->m_SpecularColor.x,
|
|
material->m_SpecularColor.y,
|
|
material->m_SpecularColor.z ) );
|
|
|
|
vrml_material.Append( wxString::Format( wxT( "diffuseColor %f %f %f\n" ),
|
|
material->m_DiffuseColor.x,
|
|
material->m_DiffuseColor.y,
|
|
material->m_DiffuseColor.z ) );
|
|
|
|
vrml_material.Append( wxString::Format( wxT( "emissiveColor %f %f %f\n" ),
|
|
material->m_EmissiveColor.x,
|
|
material->m_EmissiveColor.y,
|
|
material->m_EmissiveColor.z ) );
|
|
|
|
vrml_material.Append( wxString::Format( wxT( "ambientIntensity %f\n"),
|
|
material->m_AmbientIntensity ) );
|
|
|
|
vrml_material.Append( wxString::Format( wxT( "shininess %f\n"),
|
|
material->m_Shininess ) );
|
|
|
|
vrml_material.Append( wxString::Format( wxT( "transparency %f\n"),
|
|
material->m_Transparency ) );
|
|
|
|
vrml_materials.push_back( vrml_material );
|
|
|
|
material->SetMaterial();
|
|
return;
|
|
}
|
|
}
|
|
|
|
D( printf( "ReadMaterial error: material not found\n" ) );
|
|
}
|
|
}
|
|
|
|
|
|
bool X3D_MODEL_PARSER::parseDoubleTriplet( const wxString& aData,
|
|
S3D_VERTEX& aResult )
|
|
{
|
|
wxStringTokenizer tokens(aData);
|
|
|
|
return tokens.GetNextToken().ToDouble( &aResult.x ) &&
|
|
tokens.GetNextToken().ToDouble( &aResult.y ) &&
|
|
tokens.GetNextToken().ToDouble( &aResult.z );
|
|
}
|
|
|
|
|
|
void X3D_MODEL_PARSER::rotate( S3D_VERTEX& aV,
|
|
S3D_VERTEX& aU,
|
|
double angle )
|
|
{
|
|
S3D_VERTEX rotated;
|
|
double C = cos( angle );
|
|
double S = sin( angle );
|
|
double t = 1.0 - C;
|
|
|
|
rotated.x = ( t * aU.x * aU.x + C ) * aV.x +
|
|
( t * aU.x * aU.y - S * aU.z ) * aV.y +
|
|
( t * aU.x * aU.z + S * aU.y ) * aV.z;
|
|
|
|
rotated.y = ( t * aU.x * aU.y + S * aU.z ) * aV.x +
|
|
( t * aU.y * aU.y + C ) * aV.y +
|
|
( t * aU.y * aU.z - S * aU.x ) * aV.z;
|
|
|
|
rotated.z = ( t * aU.x * aU.z - S * aU.y ) * aV.x +
|
|
( t * aU.y * aU.z + S * aU.x ) * aV.y +
|
|
( t * aU.z * aU.z + C) * aV.z;
|
|
|
|
aV.x = rotated.x;
|
|
aV.y = rotated.y;
|
|
aV.z = rotated.z;
|
|
}
|
|
|
|
|
|
/* Steps:
|
|
* 1. Read transform data
|
|
* 2. Read vertex triplets
|
|
* 3. Read coordinate indexes
|
|
* 4. Apply geometry to Master object
|
|
*/
|
|
void X3D_MODEL_PARSER::readIndexedFaceSet( wxXmlNode* aFaceNode,
|
|
PROPERTY_MAP& aTransformProps)
|
|
{
|
|
/* Step 1: Read transform data
|
|
* --------------------------- */
|
|
|
|
S3D_VERTEX translation;
|
|
parseDoubleTriplet( aTransformProps[ wxT( "translation" ) ], translation );
|
|
|
|
S3D_VERTEX scale;
|
|
parseDoubleTriplet( aTransformProps[ wxT( "scale" ) ], scale );
|
|
|
|
S3D_VERTEX rotation;
|
|
double angle = 0.0;
|
|
wxStringTokenizer tokens(aTransformProps[ wxT( "rotation" ) ]);
|
|
|
|
if( !(tokens.GetNextToken().ToDouble( &rotation.x ) &&
|
|
tokens.GetNextToken().ToDouble( &rotation.y ) &&
|
|
tokens.GetNextToken().ToDouble( &rotation.z ) &&
|
|
tokens.GetNextToken().ToDouble( &angle ) ) )
|
|
{
|
|
D( printf("rotation read error") );
|
|
}
|
|
|
|
double vrmlunits_to_3Dunits = g_Parm_3D_Visu.m_BiuTo3Dunits *
|
|
UNITS3D_TO_UNITSPCB;
|
|
|
|
/* Step 2: Read all coordinate points
|
|
* ---------------------------- */
|
|
std::vector< double > points;
|
|
NODE_LIST coordinates;
|
|
GetChildsByName( aFaceNode, wxT( "Coordinate" ), coordinates);
|
|
|
|
PROPERTY_MAP coordinate_properties;
|
|
// IndexedFaceSet has one Coordinate child node
|
|
GetNodeProperties( coordinates[0], coordinate_properties );
|
|
|
|
// Save points to vector as doubles
|
|
wxStringTokenizer point_tokens( coordinate_properties[ wxT("point") ] );
|
|
double point = 0.0;
|
|
|
|
while( point_tokens.HasMoreTokens() )
|
|
{
|
|
if( point_tokens.GetNextToken().ToDouble( &point ) )
|
|
{
|
|
points.push_back( point );
|
|
}
|
|
else
|
|
{
|
|
wxLogError( wxT( "Error converting to double" ) );
|
|
}
|
|
}
|
|
|
|
if( points.size() % 3 != 0 )
|
|
{
|
|
D( printf( "Number of points is incorrect" ) );
|
|
return;
|
|
}
|
|
|
|
/* Create 3D vertex from 3 points and
|
|
* apply transforms in order of SCALE, ROTATION, TRANSLATION
|
|
*/
|
|
wxString vrml_pointlist;
|
|
std::vector< S3D_VERTEX > triplets;
|
|
|
|
for( unsigned id = 0; id < points.size() / 3; id++ )
|
|
{
|
|
int triplet_indx = id * 3;
|
|
S3D_VERTEX point( points[ triplet_indx ],
|
|
points[ triplet_indx + 1 ],
|
|
points[ triplet_indx + 2 ] );
|
|
|
|
point.x *= scale.x;
|
|
point.y *= scale.y;
|
|
point.z *= scale.z;
|
|
|
|
rotate( point, rotation, angle );
|
|
|
|
point.x += translation.x;
|
|
point.y += translation.y;
|
|
point.z += translation.z;
|
|
|
|
triplets.push_back(point);
|
|
|
|
// VRML
|
|
vrml_pointlist.Append( wxString::Format( wxT( "%f %f %f\n" ), point.x, point.y, point.z ) );
|
|
}
|
|
|
|
vrml_points.push_back( vrml_pointlist );
|
|
|
|
/* -- Read coordinate indexes -- */
|
|
PROPERTY_MAP faceset_properties;
|
|
GetNodeProperties( aFaceNode, faceset_properties );
|
|
|
|
std::vector< S3D_VERTEX > vertices;
|
|
std::vector< int > coordIndex;
|
|
|
|
wxString coordIndex_str = faceset_properties[ wxT( "coordIndex" ) ];
|
|
wxStringTokenizer index_tokens( coordIndex_str );
|
|
|
|
wxString vrml_coord_indx_list;
|
|
|
|
while( index_tokens.HasMoreTokens() )
|
|
{
|
|
long index = 0;
|
|
index_tokens.GetNextToken().ToLong( &index );
|
|
|
|
// -1 marks the end of polygon
|
|
if( index < 0 )
|
|
{
|
|
/* Step 4: Apply geometry to Master object
|
|
* --------------------------------------- */
|
|
std::vector<int>::const_iterator id;
|
|
|
|
for( id = coordIndex.begin();
|
|
id != coordIndex.end();
|
|
id++ )
|
|
{
|
|
vertices.push_back( triplets.at( *id ) );
|
|
}
|
|
|
|
GetMaster()->Set_Object_Coords( vertices );
|
|
Set_Object_Data( vertices, vrmlunits_to_3Dunits );
|
|
|
|
vertices.clear();
|
|
coordIndex.clear();
|
|
vrml_coord_indx_list.Append( wxT( "-1\n" ) );
|
|
}
|
|
else
|
|
{
|
|
coordIndex.push_back( index );
|
|
vrml_coord_indx_list.Append( wxString::Format( wxT( "%u " ), index ) );
|
|
}
|
|
}
|
|
|
|
vrml_coord_indexes.push_back( vrml_coord_indx_list );
|
|
}
|