728 lines
19 KiB
C++
728 lines
19 KiB
C++
/*
|
|
Bullet Continuous Collision Detection and Physics Library
|
|
Copyright (c) 2003-2006 Erwin Coumans http://continuousphysics.com/Bullet/
|
|
|
|
This software is provided 'as-is', without any express or implied warranty.
|
|
In no event will the authors be held liable for any damages arising from the use of this software.
|
|
Permission is granted to anyone to use this software for any purpose,
|
|
including commercial applications, and to alter it and redistribute it freely,
|
|
subject to the following restrictions:
|
|
|
|
1. The origin of this software must not be misrepresented; you must not claim that you wrote the original software. If you use this software in a product, an acknowledgment in the product documentation would be appreciated but is not required.
|
|
2. Altered source versions must be plainly marked as such, and must not be misrepresented as being the original software.
|
|
3. This notice may not be removed or altered from any source distribution.
|
|
*/
|
|
|
|
#ifdef WIN32 //needed for glut.h
|
|
#include <windows.h>
|
|
#endif
|
|
|
|
//think different
|
|
#if defined(__APPLE__) && !defined (VMDMESA)
|
|
#include <OpenGL/gl.h>
|
|
#include <OpenGL/glu.h>
|
|
#include <GLUT/glut.h>
|
|
#else
|
|
#include <GL/glut.h>
|
|
#endif
|
|
|
|
#include "GlutStuff.h"
|
|
#include "GL_ShapeDrawer.h"
|
|
#include "BulletCollision/CollisionShapes/btPolyhedralConvexShape.h"
|
|
#include "BulletCollision/CollisionShapes/btTriangleMeshShape.h"
|
|
#include "BulletCollision/CollisionShapes/btBoxShape.h"
|
|
#include "BulletCollision/CollisionShapes/btSphereShape.h"
|
|
#include "BulletCollision/CollisionShapes/btConeShape.h"
|
|
#include "BulletCollision/CollisionShapes/btCylinderShape.h"
|
|
#include "BulletCollision/CollisionShapes/btTetrahedronShape.h"
|
|
#include "BulletCollision/CollisionShapes/btCompoundShape.h"
|
|
#include "BulletCollision/CollisionShapes/btCapsuleShape.h"
|
|
#include "BulletCollision/CollisionShapes/btConvexTriangleMeshShape.h"
|
|
#include "BulletCollision/CollisionShapes/btUniformScalingShape.h"
|
|
|
|
|
|
|
|
#include "LinearMath/btIDebugDraw.h"
|
|
//for debugmodes
|
|
#include "BMF_Api.h"
|
|
#include <stdio.h> //printf debugging
|
|
|
|
class GlDrawcallback : public btTriangleCallback
|
|
{
|
|
public:
|
|
bool m_wireframe;
|
|
|
|
virtual void processTriangle(btVector3* triangle,int partId, int triangleIndex)
|
|
{
|
|
if (m_wireframe)
|
|
{
|
|
glBegin(GL_LINES);
|
|
glColor3f(1, 0, 0);
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 1, 0);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 0, 1);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glEnd();
|
|
} else
|
|
{
|
|
btVector3 diff1 = triangle[1] - triangle[0];
|
|
btVector3 diff2 = triangle[2] - triangle[0];
|
|
btVector3 normal = diff1.cross(diff2);
|
|
normal.normalize();
|
|
glBegin(GL_TRIANGLES);
|
|
glColor3f(1.0f, 0.3f, 0.6f);
|
|
glNormal3d(normal.getX(),normal.getY(),normal.getZ());
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glColor3f(1.0f, 0.3f, 0.6f);
|
|
glNormal3d(normal.getX(),normal.getY(),normal.getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(1.0f, 0.3f, 0.6f);
|
|
glNormal3d(normal.getX(),normal.getY(),normal.getZ());
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glEnd();
|
|
}
|
|
}
|
|
};
|
|
|
|
class GlDrawcallback_plane : public btTriangleCallback
|
|
{
|
|
public:
|
|
bool m_wireframe;
|
|
|
|
virtual void processTriangle(btVector3* triangle,int partId, int triangleIndex)
|
|
{
|
|
if(m_wireframe)
|
|
{
|
|
glDisable(GL_CULL_FACE);
|
|
glBegin(GL_LINES);
|
|
glColor3f(0.5, 0, 1);
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0.5, 0, 1);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0.5, 0, 1);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glEnd();
|
|
}
|
|
else
|
|
{
|
|
glBegin(GL_TRIANGLES);
|
|
glColor3f(0.4, -0.4, 0.5);
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
|
|
glColor3f(0.4, -0.4, 1.0);
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
|
|
glColor3f(0.4, -0.4, 0.5);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glEnd();
|
|
}
|
|
}
|
|
};
|
|
|
|
|
|
|
|
class TriangleGlDrawcallback : public btInternalTriangleIndexCallback
|
|
{
|
|
public:
|
|
virtual void internalProcessTriangleIndex(btVector3* triangle,int partId,int triangleIndex)
|
|
{
|
|
glBegin(GL_TRIANGLES);//LINES);
|
|
glColor3f(1, 0, 0);
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 1, 0);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 0, 1);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glEnd();
|
|
}
|
|
};
|
|
|
|
|
|
|
|
#define USE_DISPLAY_LISTS 1
|
|
#ifdef USE_DISPLAY_LISTS
|
|
|
|
//Set for storing Display list per trimesh
|
|
struct TRIMESH_KEY
|
|
{
|
|
btCollisionShape* m_shape;
|
|
GLuint m_dlist;//OpenGL display list
|
|
GLuint m_dlist_wireframe;//OpenGL display list
|
|
|
|
inline bool operator <(const TRIMESH_KEY& other) const
|
|
{
|
|
return (m_shape < other.m_shape);
|
|
}
|
|
|
|
inline bool operator >(const TRIMESH_KEY& other) const
|
|
{
|
|
return (m_shape > other.m_shape);
|
|
}
|
|
};
|
|
|
|
typedef btAlignedObjectArray<TRIMESH_KEY> TRIMESH_KEY_MAP;
|
|
|
|
TRIMESH_KEY_MAP g_display_lists;
|
|
|
|
TRIMESH_KEY * OGL_get_displaylist_for_shape(btCollisionShape * shape)
|
|
{
|
|
if(g_display_lists.size()==0) return 0;
|
|
|
|
TRIMESH_KEY searchkey;
|
|
searchkey.m_shape = shape;
|
|
|
|
int map_iter = g_display_lists.findBinarySearch(searchkey);
|
|
if(map_iter < g_display_lists.size())
|
|
{
|
|
return &g_display_lists[map_iter];
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void OGL_displaylist_clean()
|
|
{
|
|
int map_iter = g_display_lists.size();
|
|
|
|
while(map_iter--)
|
|
{
|
|
glDeleteLists(g_display_lists[map_iter].m_dlist,1);
|
|
glDeleteLists(g_display_lists[map_iter].m_dlist_wireframe,1);
|
|
}
|
|
|
|
g_display_lists.clear();
|
|
}
|
|
|
|
TRIMESH_KEY * OGL_displaylist_register_shape(btCollisionShape * shape)
|
|
{
|
|
btVector3 aabbMax(1e30f,1e30f,1e30f);
|
|
btVector3 aabbMin(-1e30f,-1e30f,-1e30f);
|
|
GlDrawcallback drawCallback;
|
|
|
|
TRIMESH_KEY dlist;
|
|
|
|
dlist.m_dlist = glGenLists(1);
|
|
dlist.m_dlist_wireframe = glGenLists(1);
|
|
dlist.m_shape = shape;
|
|
|
|
if (shape->getShapeType() == TRIANGLE_MESH_SHAPE_PROXYTYPE)
|
|
{
|
|
btConcaveShape* concaveMesh = (btConcaveShape*) shape;
|
|
//Draw
|
|
glNewList(dlist.m_dlist,GL_COMPILE);
|
|
glDisable(GL_CULL_FACE);
|
|
drawCallback.m_wireframe = false;
|
|
concaveMesh->processAllTriangles(&drawCallback,aabbMin,aabbMax);
|
|
glEndList();
|
|
|
|
//Draw wireframe
|
|
glNewList(dlist.m_dlist_wireframe,GL_COMPILE);
|
|
glDisable(GL_CULL_FACE);
|
|
drawCallback.m_wireframe = true;
|
|
concaveMesh->processAllTriangles(&drawCallback,aabbMin,aabbMax);
|
|
glEndList();
|
|
}
|
|
else if (shape->getShapeType() == GIMPACT_SHAPE_PROXYTYPE)
|
|
{
|
|
btConcaveShape* gimpactMesh = (btConcaveShape*) shape;
|
|
|
|
//Draw
|
|
glNewList(dlist.m_dlist,GL_COMPILE);
|
|
//glEnable(GL_CULL_FACE);
|
|
//glCullFace(GL_BACK);
|
|
glDisable(GL_CULL_FACE);
|
|
drawCallback.m_wireframe = false;
|
|
gimpactMesh->processAllTriangles(&drawCallback,aabbMin,aabbMax);
|
|
//glDisable(GL_CULL_FACE);
|
|
glEndList();
|
|
|
|
//Draw wireframe
|
|
glNewList(dlist.m_dlist_wireframe,GL_COMPILE);
|
|
glDisable(GL_CULL_FACE);
|
|
drawCallback.m_wireframe = true;
|
|
gimpactMesh->processAllTriangles(&drawCallback,aabbMin,aabbMax);
|
|
glEndList();
|
|
}
|
|
else if (shape->getShapeType() == STATIC_PLANE_PROXYTYPE)
|
|
{
|
|
GlDrawcallback_plane drawPlaneCallback;
|
|
btVector3 paabbMax(100.f,100.f,100.f);
|
|
btVector3 paabbMin(-100.f,-100.f,-100.f);
|
|
|
|
btConcaveShape* planeshape = (btConcaveShape*) shape;
|
|
|
|
//Draw
|
|
glNewList(dlist.m_dlist,GL_COMPILE);
|
|
glDisable(GL_CULL_FACE);
|
|
drawPlaneCallback.m_wireframe = false;
|
|
planeshape->processAllTriangles(&drawPlaneCallback,paabbMin,paabbMax);
|
|
glEndList();
|
|
|
|
//Draw wireframe
|
|
glNewList(dlist.m_dlist_wireframe,GL_COMPILE);
|
|
glDisable(GL_CULL_FACE);
|
|
drawPlaneCallback.m_wireframe = true;
|
|
planeshape->processAllTriangles(&drawPlaneCallback,paabbMin,paabbMax);
|
|
glEndList();
|
|
}
|
|
|
|
g_display_lists.push_back(dlist);
|
|
g_display_lists.heapSort(TRIMESH_KEY_MAP::less());
|
|
|
|
int inserted = g_display_lists.findBinarySearch(dlist);
|
|
|
|
return &g_display_lists[inserted];
|
|
}
|
|
|
|
void OGL_draw_shape(btCollisionShape* shape, bool wireframe)
|
|
{
|
|
TRIMESH_KEY * dlist = OGL_get_displaylist_for_shape(shape);
|
|
|
|
if(dlist == 0)
|
|
{
|
|
dlist = OGL_displaylist_register_shape(shape);
|
|
}
|
|
if(wireframe)
|
|
{
|
|
glCallList(dlist->m_dlist_wireframe);
|
|
}
|
|
else
|
|
{
|
|
glCallList(dlist->m_dlist);
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif //USE_DISPLAY_LISTS
|
|
|
|
void GL_ShapeDrawer::drawCoordSystem() {
|
|
glBegin(GL_LINES);
|
|
glColor3f(1, 0, 0);
|
|
glVertex3d(0, 0, 0);
|
|
glVertex3d(1, 0, 0);
|
|
glColor3f(0, 1, 0);
|
|
glVertex3d(0, 0, 0);
|
|
glVertex3d(0, 1, 0);
|
|
glColor3f(0, 0, 1);
|
|
glVertex3d(0, 0, 0);
|
|
glVertex3d(0, 0, 1);
|
|
glEnd();
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
class GlDrawcallback : public btTriangleCallback
|
|
{
|
|
|
|
public:
|
|
|
|
bool m_wireframe;
|
|
|
|
GlDrawcallback()
|
|
:m_wireframe(false)
|
|
{
|
|
}
|
|
|
|
virtual void processTriangle(btVector3* triangle,int partId, int triangleIndex)
|
|
{
|
|
|
|
(void)triangleIndex;
|
|
(void)partId;
|
|
|
|
|
|
if (m_wireframe)
|
|
{
|
|
glBegin(GL_LINES);
|
|
glColor3f(1, 0, 0);
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 1, 0);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 0, 1);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glEnd();
|
|
} else
|
|
{
|
|
glBegin(GL_TRIANGLES);
|
|
glColor3f(1, 0, 0);
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glColor3f(0, 1, 0);
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 0, 1);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glEnd();
|
|
}
|
|
}
|
|
};
|
|
*/
|
|
|
|
/*class TriangleGlDrawcallback : public btInternalTriangleIndexCallback
|
|
{
|
|
public:
|
|
virtual void internalProcessTriangleIndex(btVector3* triangle,int partId,int triangleIndex)
|
|
{
|
|
(void)triangleIndex;
|
|
(void)partId;
|
|
|
|
|
|
glBegin(GL_TRIANGLES);//LINES);
|
|
glColor3f(1, 0, 0);
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 1, 0);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[1].getX(), triangle[1].getY(), triangle[1].getZ());
|
|
glColor3f(0, 0, 1);
|
|
glVertex3d(triangle[2].getX(), triangle[2].getY(), triangle[2].getZ());
|
|
glVertex3d(triangle[0].getX(), triangle[0].getY(), triangle[0].getZ());
|
|
glEnd();
|
|
}
|
|
};*/
|
|
|
|
void GL_ShapeDrawer::drawCylinder(float radius,float halfHeight, int upAxis)
|
|
{
|
|
|
|
|
|
glPushMatrix();
|
|
switch (upAxis)
|
|
{
|
|
case 0:
|
|
glRotatef(-90.0, 0.0, 1.0, 0.0);
|
|
glTranslatef(0.0, 0.0, -halfHeight);
|
|
break;
|
|
case 1:
|
|
glRotatef(-90.0, 1.0, 0.0, 0.0);
|
|
glTranslatef(0.0, 0.0, -halfHeight);
|
|
break;
|
|
case 2:
|
|
|
|
glTranslatef(0.0, 0.0, -halfHeight);
|
|
break;
|
|
default:
|
|
{
|
|
assert(0);
|
|
}
|
|
|
|
}
|
|
|
|
GLUquadricObj *quadObj = gluNewQuadric();
|
|
|
|
//The gluCylinder subroutine draws a cylinder that is oriented along the z axis.
|
|
//The base of the cylinder is placed at z = 0; the top of the cylinder is placed at z=height.
|
|
//Like a sphere, the cylinder is subdivided around the z axis into slices and along the z axis into stacks.
|
|
|
|
gluQuadricDrawStyle(quadObj, (GLenum)GLU_FILL);
|
|
gluQuadricNormals(quadObj, (GLenum)GLU_SMOOTH);
|
|
|
|
|
|
gluCylinder(quadObj, radius, radius, 2.f*halfHeight, 15, 10);
|
|
glPopMatrix();
|
|
gluDeleteQuadric(quadObj);
|
|
}
|
|
|
|
void GL_ShapeDrawer::drawOpenGL(btScalar* m, const btCollisionShape* shape, const btVector3& color,int debugMode)
|
|
{
|
|
|
|
|
|
glPushMatrix();
|
|
btglMultMatrix(m);
|
|
|
|
if (shape->getShapeType() == UNIFORM_SCALING_SHAPE_PROXYTYPE)
|
|
{
|
|
const btUniformScalingShape* scalingShape = static_cast<const btUniformScalingShape*>(shape);
|
|
const btConvexShape* convexShape = scalingShape->getChildShape();
|
|
float scalingFactor = (float)scalingShape->getUniformScalingFactor();
|
|
{
|
|
btScalar tmpScaling[4][4]={scalingFactor,0,0,0,
|
|
0,scalingFactor,0,0,
|
|
0,0,scalingFactor,0,
|
|
0,0,0,1};
|
|
|
|
drawOpenGL( (btScalar*)tmpScaling,convexShape,color,debugMode);
|
|
}
|
|
glPopMatrix();
|
|
return;
|
|
}
|
|
|
|
if (shape->getShapeType() == COMPOUND_SHAPE_PROXYTYPE)
|
|
{
|
|
const btCompoundShape* compoundShape = static_cast<const btCompoundShape*>(shape);
|
|
for (int i=compoundShape->getNumChildShapes()-1;i>=0;i--)
|
|
{
|
|
btTransform childTrans = compoundShape->getChildTransform(i);
|
|
const btCollisionShape* colShape = compoundShape->getChildShape(i);
|
|
btScalar childMat[16];
|
|
childTrans.getOpenGLMatrix(childMat);
|
|
drawOpenGL(childMat,colShape,color,debugMode);
|
|
}
|
|
|
|
} else
|
|
{
|
|
//drawCoordSystem();
|
|
|
|
//glPushMatrix();
|
|
glEnable(GL_COLOR_MATERIAL);
|
|
glColor3f(color.x(),color.y(), color.z());
|
|
|
|
|
|
|
|
bool useWireframeFallback = true;
|
|
|
|
if (!(debugMode & btIDebugDraw::DBG_DrawWireframe))
|
|
{
|
|
switch (shape->getShapeType())
|
|
{
|
|
case BOX_SHAPE_PROXYTYPE:
|
|
{
|
|
const btBoxShape* boxShape = static_cast<const btBoxShape*>(shape);
|
|
btVector3 halfExtent = boxShape->getHalfExtents();
|
|
glScaled(2*halfExtent[0], 2*halfExtent[1], 2*halfExtent[2]);
|
|
glutSolidCube(1.0);
|
|
useWireframeFallback = false;
|
|
break;
|
|
}
|
|
case TRIANGLE_SHAPE_PROXYTYPE:
|
|
case TETRAHEDRAL_SHAPE_PROXYTYPE:
|
|
{
|
|
//todo:
|
|
// useWireframeFallback = false;
|
|
break;
|
|
}
|
|
case CONVEX_HULL_SHAPE_PROXYTYPE:
|
|
break;
|
|
case SPHERE_SHAPE_PROXYTYPE:
|
|
{
|
|
const btSphereShape* sphereShape = static_cast<const btSphereShape*>(shape);
|
|
float radius = sphereShape->getMargin();//radius doesn't include the margin, so draw with margin
|
|
glutSolidSphere(radius,10,10);
|
|
useWireframeFallback = false;
|
|
break;
|
|
}
|
|
case CAPSULE_SHAPE_PROXYTYPE:
|
|
{
|
|
const btCapsuleShape* capsuleShape = static_cast<const btCapsuleShape*>(shape);
|
|
float radius = capsuleShape->getRadius();
|
|
float halfHeight = capsuleShape->getHalfHeight();
|
|
int upAxis = 1;
|
|
|
|
drawCylinder(radius,halfHeight,upAxis);
|
|
|
|
|
|
glPushMatrix();
|
|
glTranslatef(0.0, -halfHeight,0.0);
|
|
glutSolidSphere(radius,10,10);
|
|
glTranslatef(0.0, 2*halfHeight,0.0);
|
|
glutSolidSphere(radius,10,10);
|
|
glPopMatrix();
|
|
useWireframeFallback = false;
|
|
break;
|
|
}
|
|
case MULTI_SPHERE_SHAPE_PROXYTYPE:
|
|
{
|
|
break;
|
|
}
|
|
case CONE_SHAPE_PROXYTYPE:
|
|
{
|
|
const btConeShape* coneShape = static_cast<const btConeShape*>(shape);
|
|
float radius = coneShape->getRadius();//+coneShape->getMargin();
|
|
float height = coneShape->getHeight();//+coneShape->getMargin();
|
|
//glRotatef(-90.0, 1.0, 0.0, 0.0);
|
|
glTranslatef(0.0, 0.0, -0.5*height);
|
|
glutSolidCone(radius,height,10,10);
|
|
useWireframeFallback = false;
|
|
break;
|
|
|
|
}
|
|
case CONVEX_TRIANGLEMESH_SHAPE_PROXYTYPE:
|
|
{
|
|
useWireframeFallback = false;
|
|
break;
|
|
}
|
|
|
|
case CONVEX_SHAPE_PROXYTYPE:
|
|
case CYLINDER_SHAPE_PROXYTYPE:
|
|
{
|
|
const btCylinderShape* cylinder = static_cast<const btCylinderShape*>(shape);
|
|
int upAxis = cylinder->getUpAxis();
|
|
|
|
|
|
float radius = cylinder->getRadius();
|
|
float halfHeight = cylinder->getHalfExtents()[upAxis];
|
|
|
|
drawCylinder(radius,halfHeight,upAxis);
|
|
|
|
break;
|
|
}
|
|
default:
|
|
{
|
|
}
|
|
|
|
};
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (useWireframeFallback)
|
|
{
|
|
/// for polyhedral shapes
|
|
if (shape->isPolyhedral())
|
|
{
|
|
btPolyhedralConvexShape* polyshape = (btPolyhedralConvexShape*) shape;
|
|
|
|
|
|
glBegin(GL_LINES);
|
|
|
|
|
|
int i;
|
|
for (i=0;i<polyshape->getNumEdges();i++)
|
|
{
|
|
btPoint3 a,b;
|
|
polyshape->getEdge(i,a,b);
|
|
|
|
glVertex3f(a.getX(),a.getY(),a.getZ());
|
|
glVertex3f(b.getX(),b.getY(),b.getZ());
|
|
|
|
|
|
}
|
|
glEnd();
|
|
|
|
|
|
if (debugMode==btIDebugDraw::DBG_DrawFeaturesText)
|
|
{
|
|
glRasterPos3f(0.0, 0.0, 0.0);
|
|
//BMF_DrawString(BMF_GetFont(BMF_kHelvetica10),polyshape->getExtraDebugInfo());
|
|
|
|
glColor3f(1.f, 1.f, 1.f);
|
|
for (i=0;i<polyshape->getNumVertices();i++)
|
|
{
|
|
btPoint3 vtx;
|
|
polyshape->getVertex(i,vtx);
|
|
glRasterPos3f(vtx.x(), vtx.y(), vtx.z());
|
|
char buf[12];
|
|
sprintf(buf," %d",i);
|
|
BMF_DrawString(BMF_GetFont(BMF_kHelvetica10),buf);
|
|
}
|
|
|
|
for (i=0;i<polyshape->getNumPlanes();i++)
|
|
{
|
|
btVector3 normal;
|
|
btPoint3 vtx;
|
|
polyshape->getPlane(normal,vtx,i);
|
|
btScalar d = vtx.dot(normal);
|
|
|
|
glRasterPos3f(normal.x()*d, normal.y()*d, normal.z()*d);
|
|
char buf[12];
|
|
sprintf(buf," plane %d",i);
|
|
BMF_DrawString(BMF_GetFont(BMF_kHelvetica10),buf);
|
|
|
|
}
|
|
}
|
|
|
|
|
|
}
|
|
}
|
|
|
|
|
|
#ifdef USE_DISPLAY_LISTS
|
|
if (shape->getShapeType() == TRIANGLE_MESH_SHAPE_PROXYTYPE||
|
|
shape->getShapeType() == GIMPACT_SHAPE_PROXYTYPE||
|
|
shape->getShapeType() == STATIC_PLANE_PROXYTYPE)
|
|
{
|
|
if((debugMode & btIDebugDraw::DBG_DrawWireframe)!=0)
|
|
{
|
|
OGL_draw_shape((btCollisionShape *)shape,true);
|
|
}
|
|
else
|
|
{
|
|
OGL_draw_shape((btCollisionShape *)shape,false);
|
|
}
|
|
|
|
|
|
}
|
|
#else
|
|
if (shape->getShapeType() == TRIANGLE_MESH_SHAPE_PROXYTYPE||shape->getShapeType() == GIMPACT_SHAPE_PROXYTYPE)
|
|
{
|
|
btConcaveShape* concaveMesh = (btTriangleMeshShape*) shape;
|
|
//btVector3 aabbMax(1e30f,1e30f,1e30f);
|
|
//btVector3 aabbMax(100,100,100);//1e30f,1e30f,1e30f);
|
|
|
|
//todo pass camera, for some culling
|
|
btVector3 aabbMax(1e30f,1e30f,1e30f);
|
|
btVector3 aabbMin(-1e30f,-1e30f,-1e30f);
|
|
|
|
GlDrawcallback drawCallback;
|
|
drawCallback.m_wireframe = (debugMode & btIDebugDraw::DBG_DrawWireframe)!=0;
|
|
|
|
concaveMesh->processAllTriangles(&drawCallback,aabbMin,aabbMax);
|
|
|
|
}
|
|
else if (shape->getShapeType() == STATIC_PLANE_PROXYTYPE)
|
|
{
|
|
|
|
GlDrawcallback_plane drawPlaneCallback;
|
|
btVector3 paabbMax(100.f,100.f,100.f);
|
|
btVector3 paabbMin(-100.f,-100.f,-100.f);
|
|
|
|
btConcaveShape* planeshape = (btConcaveShape*) shape;
|
|
|
|
drawPlaneCallback.m_wireframe = (debugMode & btIDebugDraw::DBG_DrawWireframe)!=0;
|
|
//Draw
|
|
glDisable(GL_CULL_FACE);
|
|
planeshape->processAllTriangles(&drawPlaneCallback,paabbMin,paabbMax);
|
|
}
|
|
|
|
|
|
#endif
|
|
|
|
|
|
if (shape->getShapeType() == CONVEX_TRIANGLEMESH_SHAPE_PROXYTYPE)
|
|
{
|
|
btConvexTriangleMeshShape* convexMesh = (btConvexTriangleMeshShape*) shape;
|
|
|
|
//todo: pass camera for some culling
|
|
btVector3 aabbMax(btScalar(1e30),btScalar(1e30),btScalar(1e30));
|
|
btVector3 aabbMin(-btScalar(1e30),-btScalar(1e30),-btScalar(1e30));
|
|
TriangleGlDrawcallback drawCallback;
|
|
convexMesh->getStridingMesh()->InternalProcessAllTriangles(&drawCallback,aabbMin,aabbMax);
|
|
|
|
}
|
|
|
|
|
|
glDisable(GL_DEPTH_BUFFER_BIT);
|
|
glRasterPos3f(0,0,0);//mvtx.x(), vtx.y(), vtx.z());
|
|
if (debugMode&btIDebugDraw::DBG_DrawText)
|
|
{
|
|
BMF_DrawString(BMF_GetFont(BMF_kHelvetica10),shape->getName());
|
|
}
|
|
|
|
if (debugMode& btIDebugDraw::DBG_DrawFeaturesText)
|
|
{
|
|
//BMF_DrawString(BMF_GetFont(BMF_kHelvetica10),shape->getExtraDebugInfo());
|
|
}
|
|
glEnable(GL_DEPTH_BUFFER_BIT);
|
|
|
|
// glPopMatrix();
|
|
}
|
|
glPopMatrix();
|
|
|
|
}
|