open_toontown_panda3d/panda/src/ode/odeTriMeshData.cxx

307 lines
9.5 KiB
C++
Executable File

// Filename: odeTriMeshData.cxx
// Created by: joswilso (27Dec06)
//
////////////////////////////////////////////////////////////////////
//
// PANDA 3D SOFTWARE
// Copyright (c) 2001 - 2004, Disney Enterprises, Inc. All rights reserved
//
// All use of this software is subject to the terms of the Panda 3d
// Software license. You should have received a copy of this license
// along with this source code; you will also find a current copy of
// the license at http://etc.cmu.edu/panda3d/docs/license/ .
//
// To contact the maintainers of this program write to
// panda3d-general@lists.sourceforge.net .
//
////////////////////////////////////////////////////////////////////
#include "config_ode.h"
#include "odeTriMeshData.h"
TypeHandle OdeTriMeshData::_type_handle;
OdeTriMeshData::TriMeshDataMap OdeTriMeshData::_tri_mesh_data_map;
void OdeTriMeshData::
link_data(dGeomID id, PT(OdeTriMeshData) data) {
odetrimeshdata_cat.debug() << get_class_type() << "::link_data(" << id << "->" << data << ")" << "\n";
_tri_mesh_data_map[id] = data;
}
PT(OdeTriMeshData) OdeTriMeshData::
get_data(dGeomID id) {
TriMeshDataMap::iterator iter = _tri_mesh_data_map.find(id);
if (iter != _tri_mesh_data_map.end()) {
return iter->second;
}
return 0;
}
void OdeTriMeshData::
unlink_data(dGeomID id) {
odetrimeshdata_cat.debug() << get_class_type() << "::unlink_data(" << id << ")" << "\n";
TriMeshDataMap::iterator iter = _tri_mesh_data_map.find(id);
if (iter != _tri_mesh_data_map.end()) {
_tri_mesh_data_map.erase(iter);
}
}
void OdeTriMeshData::
print_data(const string &marker) {
odetrimeshdata_cat.debug() << get_class_type() << "::print_data(" << marker << ")\n";
TriMeshDataMap::iterator iter = _tri_mesh_data_map.begin();
for (;iter != _tri_mesh_data_map.end(); ++iter) {
odetrimeshdata_cat.debug() << "\t" << iter->first << " : " << iter->second << "\n";
}
}
void OdeTriMeshData::
remove_data(OdeTriMeshData *data) {
odetrimeshdata_cat.debug() << get_class_type() << "::remove_data(" << data->get_id() << ")" << "\n";
TriMeshDataMap::iterator iter = _tri_mesh_data_map.begin();
for (;iter != _tri_mesh_data_map.end(); ++iter) {
if ( iter->second == data ) {
_tri_mesh_data_map.erase(iter);
iter = _tri_mesh_data_map.end();
}
}
}
////////////////////////////////////////////////////////////////////
////////////////////////////////////////////////////////////////////
OdeTriMeshData::
OdeTriMeshData(const NodePath& model, bool use_normals) :
_id(dGeomTriMeshDataCreate()),
_vertices(0),
_faces(0),
_normals(false),
_num_vertices(0),
_num_faces(0) {
odetrimeshdata_cat.debug() << get_type() << "(" << _id << ")" << "\n";
process_model(model, use_normals);
write_faces(odetrimeshdata_cat.debug());
if (!use_normals) {
build_single(_vertices, sizeof(StridedVertex), _num_vertices,
_faces, _num_faces * 3, sizeof(StridedTri));
} else {
build_single1(_vertices, sizeof(StridedVertex), _num_vertices,
_faces, _num_faces * 3, sizeof(StridedTri),
_normals);
}
preprocess();
}
// Private copy constructor, shouldn't be copying these objects
OdeTriMeshData::
OdeTriMeshData(const OdeTriMeshData &other) {
}
OdeTriMeshData::
~OdeTriMeshData() {
odetrimeshdata_cat.debug() << "~" << get_type() << "(" << _id << ")" << "\n";
destroy();
if (_vertices != 0) {
delete[] _vertices;
_vertices = 0;
_num_vertices = 0;
}
if (_faces != 0) {
delete[] _faces;
_faces = 0;
}
if (_normals != 0) {
delete[] _normals;
}
}
void OdeTriMeshData::
destroy() {
odetrimeshdata_cat.debug() << get_type() << "::destroy(" << _id << ")" << "\n";
if (_id != 0) {
dGeomTriMeshDataDestroy(_id);
remove_data(this);
_id = 0;
}
}
// Private assignment operator, shouldn't be copying these objects
void OdeTriMeshData::
operator = (const OdeTriMeshData &other) {
}
void OdeTriMeshData::
process_model(const NodePath& model, bool &use_normals) {
// TODO: assert if _vertices is something other than 0.
ostream &out = odetrimeshdata_cat.debug();
out << "process_model(" << model << ")" << "\n";
NodePathCollection geomNodePaths = model.find_all_matches("**/+GeomNode");
if (model.node()->get_type() == GeomNode::get_class_type()) {
geomNodePaths.add_path(model);
}
for (int i = 0; i < geomNodePaths.get_num_paths(); ++i) {
analyze((GeomNode*)geomNodePaths[i].node());
}
odetrimeshdata_cat.debug() << "Found " << _num_vertices << " vertices.\n";
odetrimeshdata_cat.debug() << "Found " << _num_faces << " faces.\n";
_vertices = new StridedVertex[_num_vertices];
_faces = new StridedTri[_num_faces];
_num_vertices = 0, _num_faces = 0;
for (int i = 0; i < geomNodePaths.get_num_paths(); ++i) {
process_geom_node((GeomNode*)geomNodePaths[i].node());
odetrimeshdata_cat.debug() << "_num_vertices now at " << _num_vertices << "\n";
}
odetrimeshdata_cat.debug() << "Filled " << _num_faces << " triangles(" \
<< _num_vertices << " vertices)\n";
}
void OdeTriMeshData::
process_geom_node(const GeomNode *geomNode) {
ostream &out = odetrimeshdata_cat.debug();
out.width(2); out << "" << "process_geom_node(" << *geomNode << ")" << "\n";
for (int i = 0; i < geomNode->get_num_geoms(); ++i) {
process_geom(geomNode->get_geom(i));
}
}
void OdeTriMeshData::
process_geom(const Geom *geom) {
ostream &out = odetrimeshdata_cat.debug();
out.width(4); out << "" << "process_geom(" << *geom << ")" << "\n";
if (geom->get_primitive_type() != Geom::PT_polygons) {
return;
}
CPT(GeomVertexData) vData = geom->get_vertex_data();
for (int i = 0; i < geom->get_num_primitives(); ++i) {
process_primitive(geom->get_primitive(i), vData);
}
}
void OdeTriMeshData::
process_primitive(const GeomPrimitive *primitive,
CPT(GeomVertexData) vData) {
GeomVertexReader vReader(vData, "vertex");
GeomVertexReader nReader(vData, "normal");
LVecBase3f vertex, normal;
//CPT(GeomPrimitive) dPrimitive = primitive->decompose();
CPT(GeomPrimitive) dPrimitive = primitive;
ostream &out = odetrimeshdata_cat.debug();
out.width(6); out << "" << "process_primitive(" << *dPrimitive << ")" << "\n";
if (dPrimitive->get_type() == GeomTriangles::get_class_type()) {
for (int i = 0; i < dPrimitive->get_num_primitives(); i++, _num_faces++) {
int s = dPrimitive->get_primitive_start(i);
int e = dPrimitive->get_primitive_end(i);
out.width(8); out << "" << "primitive " << i << ":" << "\n";
for (int j = s, m = 0; j < e; j++, m++, _num_vertices++) {
int vRowIndex = dPrimitive->get_vertex(j);
vReader.set_row(vRowIndex);
nReader.set_row(vRowIndex);
vertex = vReader.get_data3f();
//normal = nReader.get_data3f();
_faces[_num_faces].Indices[m] = _num_vertices;
_vertices[_num_vertices].Vertex[0] = vertex[0];
_vertices[_num_vertices].Vertex[1] = vertex[1];
_vertices[_num_vertices].Vertex[2] = vertex[2];
out.width(10); out << "" << "vertex " << j << " has: pos(" \
<< vertex << ") normal(" << "normal" << ")" << "\n";
}
}
} else if (dPrimitive->get_type() == GeomTristrips::get_class_type()){
for (int i = 0; i < dPrimitive->get_num_primitives(); i++, _num_faces++) {
int s = dPrimitive->get_primitive_start(i);
int e = dPrimitive->get_primitive_end(i);
out.width(8); out << "" << "primitive " << i << ":" << "\n";
for (int j = s, m = 0; j < e; j++, m++, _num_vertices++) {
int vRowIndex = dPrimitive->get_vertex(j);
vReader.set_row(vRowIndex);
nReader.set_row(vRowIndex);
vertex = vReader.get_data3f();
//normal = nReader.get_data3f();
_vertices[_num_vertices].Vertex[0] = vertex[0];
_vertices[_num_vertices].Vertex[1] = vertex[1];
_vertices[_num_vertices].Vertex[2] = vertex[2];
out.width(10); out << "" << "vertex " << j << " has: pos(" \
<< vertex << ") normal(" << "normal" << ")" << "\n";
if (m < 3) {
_faces[_num_faces].Indices[m] = _num_vertices;
} else {
_num_faces++;
if ( m & 1) {
_faces[_num_faces].Indices[0] = _num_vertices-1;
_faces[_num_faces].Indices[1] = _num_vertices-2;
_faces[_num_faces].Indices[2] = _num_vertices;
} else {
_faces[_num_faces].Indices[0] = _num_vertices-2;
_faces[_num_faces].Indices[1] = _num_vertices-1;
_faces[_num_faces].Indices[2] = _num_vertices;
}
}
}
out << "\n";
}
}
}
void OdeTriMeshData::
analyze(const GeomNode *geomNode) {
for (int i = 0; i < geomNode->get_num_geoms(); ++i) {
analyze(geomNode->get_geom(i));
}
}
void OdeTriMeshData::
analyze(const Geom *geom) {
if (geom->get_primitive_type() != Geom::PT_polygons) {
return;
}
for (int i = 0; i < geom->get_num_primitives(); ++i) {
analyze(geom->get_primitive(i));
}
}
void OdeTriMeshData::
analyze(const GeomPrimitive *primitive) {
for (int i = 0; i < primitive->get_num_primitives(); ++i) {
_num_vertices += primitive->get_primitive_num_vertices(i);
_num_faces += primitive->get_primitive_num_faces(i);
}
}
void OdeTriMeshData::
write_faces(ostream &out) const {
out<<"\n";
for (unsigned int i = 0; i < _num_faces; ++i) {
out.width(2); out << "Face " << i << ":\n";
for (int j = 0; j < 3; ++j) {
out.width(4);
out << "(" << _vertices[_faces[i].Indices[j]].Vertex[0] \
<< ", " << _vertices[_faces[i].Indices[j]].Vertex[1] \
<< ", " << _vertices[_faces[i].Indices[j]].Vertex[2] << ")\n" ;
}
}
}
void OdeTriMeshData::
write(ostream &out, unsigned int indent) const {
out.width(indent); out << "" << get_type() << "(id = " << _id << ") : " \
<< "" << "Vertices: " << (_id ? _num_vertices : 0) << ", " \
<< "" << "Triangles: " << (_id ? _num_faces : 0);
}