source: code/branches/physics/src/ogrebullet/Collisions/Shapes/OgreBulletCollisionsTrimeshShape.cpp @ 2258

/***************************************************************************

This source file is part of OGREBULLET
(Object-oriented Graphics Rendering Engine Bullet Wrapper)
For the latest info, see http://www.ogre3d.org/phpBB2addons/viewforum.php?f=10

Copyright (c) 2007 tuan.kuranes@gmail.com (Use it Freely, even Statically, but have to contribute any changes)



This program is free software; you can redistribute it and/or modify it under
the terms of the GPL General Public License with runtime exception 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 GPL General Public License with runtime exception for more details.

You should have received a copy of the GPL General Public License with runtime exception along with
this program; if not, write to the Free Software Foundation, Inc., 59 Temple
Place - Suite 330, Boston, MA 02111-1307, USA, or go to
http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
-----------------------------------------------------------------------------
*/

#include "OgreBulletCollisions.h"

#include "Shapes/OgreBulletCollisionsTrimeshShape.h"
#include "Debug/OgreBulletCollisionsDebugLines.h"
#include "Utils/OgreBulletConverter.h"

using namespace Ogre;
using namespace OgreBulletCollisions;

namespace OgreBulletCollisions
{
    // -------------------------------------------------------------------------
    TriangleMeshCollisionShape::TriangleMeshCollisionShape(
        Vector3        *vertices, 
        unsigned int vertexCount, 
        unsigned int *indices, 
        unsigned int indexCount,
                bool use32bitsIndices) :        
        CollisionShape(),
        mTriMesh(0)
    {
                unsigned int numFaces = indexCount / 3;

                mTriMesh = new btTriangleMesh(use32bitsIndices);

        btVector3    vertexPos[3];
        for (unsigned int n = 0; n < numFaces; ++n)
        {
                        {
                                const Vector3 &vec = vertices[*indices];
                                vertexPos[0][0] = vec.x;
                                vertexPos[0][1] = vec.y;
                                vertexPos[0][2] = vec.z;
                        }
                        {
                                const Vector3 &vec = vertices[*(indices + 1)];
                                vertexPos[1][0] = vec.x;
                                vertexPos[1][1] = vec.y;
                                vertexPos[1][2] = vec.z;
                        }
                        {
                                const Vector3 &vec = vertices[*(indices + 2)];
                                vertexPos[2][0] = vec.x;
                                vertexPos[2][1] = vec.y;
                                vertexPos[2][2] = vec.z;
                        }

                        indices += 3;

            mTriMesh->addTriangle(vertexPos[0], vertexPos[1], vertexPos[2]);
        }

                const bool useQuantizedAABB = true;
        mShape = new btBvhTriangleMeshShape(mTriMesh, useQuantizedAABB);

    }
    // -------------------------------------------------------------------------
    TriangleMeshCollisionShape::~TriangleMeshCollisionShape()
    {
    }
    // -------------------------------------------------------------------------
        bool TriangleMeshCollisionShape::drawWireFrame(DebugLines *wire, 
                const Ogre::Vector3 &pos, 
                const Ogre::Quaternion &quat) const
    {
        const int numTris = mTriMesh->getNumTriangles ();
        if (numTris > 0)
        {

                        const int numSubParts = mTriMesh->getNumSubParts ();
                        for (int currSubPart = 0; currSubPart < numSubParts; currSubPart++)
                        {
                                const unsigned char* vertexBase = NULL;
                                int numVerts;
                                PHY_ScalarType vertexType;
                                int vertexStride;
                                const unsigned char* indexBase = NULL;
                                int indexStride;
                                int numFaces;
                                PHY_ScalarType indexType;

                                mTriMesh->getLockedReadOnlyVertexIndexBase (&vertexBase, numVerts, 
                                        vertexType, vertexStride, 
                                        &indexBase, indexStride, numFaces, indexType, currSubPart);

                                float* p;
                                btVector3 vert0;
                                btVector3 vert1;
                                btVector3 vert2;
                                for (int t = 0; t < numFaces; t++)
                                {
#define setVector(A, B) {A.setX(B[0]);A.setY(B[1]);A.setZ(B[2]);};

                                        if (indexType == PHY_SHORT)
                                        {
                                                short int* index = (short int*)(indexBase + t*indexStride);

                                                p = (float*)(vertexBase + index[0]*vertexStride);
                                                setVector(vert0, p);                                            
                                                p = (float*)(vertexBase + index[1]*vertexStride);
                                                setVector(vert1, p);                    
                                                p = (float*)(vertexBase + index[2]*vertexStride);
                                                setVector(vert2, p);            
                                        } 
                                        else
                                        {
                                                int* index = (int*)(indexBase + t*indexStride);

                                                p = (float*)(vertexBase + index[0]*vertexStride);
                                                setVector(vert0, p);                                            
                                                p = (float*)(vertexBase + index[1]*vertexStride);
                                                setVector(vert1, p);                    
                                                p = (float*)(vertexBase + index[2]*vertexStride);
                                                setVector(vert2, p);            
                                        }
#undef setVector

                                        wire->addLine (BtOgreConverter::to(vert0), BtOgreConverter::to(vert1));
                                        wire->addLine (BtOgreConverter::to(vert1), BtOgreConverter::to(vert2));
                                        wire->addLine (BtOgreConverter::to(vert2), BtOgreConverter::to(vert0));
                                }
                        }
            return true;
        }
        return false;
    }
}