| [1963] | 1 |  | 
|---|
 | 2 | /* | 
|---|
 | 3 | Stan Melax Convex Hull Computation | 
|---|
 | 4 | Copyright (c) 2008 Stan Melax http://www.melax.com/ | 
|---|
 | 5 |  | 
|---|
 | 6 | This software is provided 'as-is', without any express or implied warranty. | 
|---|
 | 7 | In no event will the authors be held liable for any damages arising from the use of this software. | 
|---|
 | 8 | Permission is granted to anyone to use this software for any purpose,  | 
|---|
 | 9 | including commercial applications, and to alter it and redistribute it freely,  | 
|---|
 | 10 | subject to the following restrictions: | 
|---|
 | 11 |  | 
|---|
 | 12 | 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. | 
|---|
 | 13 | 2. Altered source versions must be plainly marked as such, and must not be misrepresented as being the original software. | 
|---|
 | 14 | 3. This notice may not be removed or altered from any source distribution. | 
|---|
 | 15 | */ | 
|---|
 | 16 |  | 
|---|
 | 17 | ///includes modifications/improvements by John Ratcliff, see BringOutYourDead below. | 
|---|
 | 18 |  | 
|---|
 | 19 | #ifndef CD_HULL_H | 
|---|
 | 20 | #define CD_HULL_H | 
|---|
 | 21 |  | 
|---|
| [7983] | 22 | #include "btVector3.h" | 
|---|
 | 23 | #include "btAlignedObjectArray.h" | 
|---|
| [1963] | 24 |  | 
|---|
 | 25 | typedef btAlignedObjectArray<unsigned int> TUIntArray; | 
|---|
 | 26 |  | 
|---|
 | 27 | class HullResult | 
|---|
 | 28 | { | 
|---|
 | 29 | public: | 
|---|
 | 30 |         HullResult(void) | 
|---|
 | 31 |         { | 
|---|
 | 32 |                 mPolygons = true; | 
|---|
 | 33 |                 mNumOutputVertices = 0; | 
|---|
 | 34 |                 mNumFaces = 0; | 
|---|
 | 35 |                 mNumIndices = 0; | 
|---|
 | 36 |         } | 
|---|
 | 37 |         bool                    mPolygons;                  // true if indices represents polygons, false indices are triangles | 
|---|
 | 38 |         unsigned int            mNumOutputVertices;         // number of vertices in the output hull | 
|---|
 | 39 |         btAlignedObjectArray<btVector3> m_OutputVertices;            // array of vertices | 
|---|
 | 40 |         unsigned int            mNumFaces;                  // the number of faces produced | 
|---|
 | 41 |         unsigned int            mNumIndices;                // the total number of indices | 
|---|
 | 42 |         btAlignedObjectArray<unsigned int>    m_Indices;                   // pointer to indices. | 
|---|
 | 43 |  | 
|---|
 | 44 | // If triangles, then indices are array indexes into the vertex list. | 
|---|
 | 45 | // If polygons, indices are in the form (number of points in face) (p1, p2, p3, ..) etc.. | 
|---|
 | 46 | }; | 
|---|
 | 47 |  | 
|---|
 | 48 | enum HullFlag | 
|---|
 | 49 | { | 
|---|
 | 50 |         QF_TRIANGLES         = (1<<0),             // report results as triangles, not polygons. | 
|---|
 | 51 |         QF_REVERSE_ORDER     = (1<<1),             // reverse order of the triangle indices. | 
|---|
 | 52 |         QF_DEFAULT           = QF_TRIANGLES | 
|---|
 | 53 | }; | 
|---|
 | 54 |  | 
|---|
 | 55 |  | 
|---|
 | 56 | class HullDesc | 
|---|
 | 57 | { | 
|---|
 | 58 | public: | 
|---|
 | 59 |         HullDesc(void) | 
|---|
 | 60 |         { | 
|---|
 | 61 |                 mFlags          = QF_DEFAULT; | 
|---|
 | 62 |                 mVcount         = 0; | 
|---|
 | 63 |                 mVertices       = 0; | 
|---|
 | 64 |                 mVertexStride   = sizeof(btVector3); | 
|---|
 | 65 |                 mNormalEpsilon  = 0.001f; | 
|---|
 | 66 |                 mMaxVertices    = 4096; // maximum number of points to be considered for a convex hull. | 
|---|
 | 67 |                 mMaxFaces       = 4096; | 
|---|
 | 68 |         }; | 
|---|
 | 69 |  | 
|---|
 | 70 |         HullDesc(HullFlag flag, | 
|---|
 | 71 |                  unsigned int vcount, | 
|---|
 | 72 |                  const btVector3 *vertices, | 
|---|
 | 73 |                  unsigned int stride = sizeof(btVector3)) | 
|---|
 | 74 |         { | 
|---|
 | 75 |                 mFlags          = flag; | 
|---|
 | 76 |                 mVcount         = vcount; | 
|---|
 | 77 |                 mVertices       = vertices; | 
|---|
 | 78 |                 mVertexStride   = stride; | 
|---|
 | 79 |                 mNormalEpsilon  = btScalar(0.001); | 
|---|
 | 80 |                 mMaxVertices    = 4096; | 
|---|
 | 81 |         } | 
|---|
 | 82 |  | 
|---|
 | 83 |         bool HasHullFlag(HullFlag flag) const | 
|---|
 | 84 |         { | 
|---|
 | 85 |                 if ( mFlags & flag ) return true; | 
|---|
 | 86 |                 return false; | 
|---|
 | 87 |         } | 
|---|
 | 88 |  | 
|---|
 | 89 |         void SetHullFlag(HullFlag flag) | 
|---|
 | 90 |         { | 
|---|
 | 91 |                 mFlags|=flag; | 
|---|
 | 92 |         } | 
|---|
 | 93 |  | 
|---|
 | 94 |         void ClearHullFlag(HullFlag flag) | 
|---|
 | 95 |         { | 
|---|
 | 96 |                 mFlags&=~flag; | 
|---|
 | 97 |         } | 
|---|
 | 98 |  | 
|---|
 | 99 |         unsigned int      mFlags;           // flags to use when generating the convex hull. | 
|---|
 | 100 |         unsigned int      mVcount;          // number of vertices in the input point cloud | 
|---|
 | 101 |         const btVector3  *mVertices;        // the array of vertices. | 
|---|
 | 102 |         unsigned int      mVertexStride;    // the stride of each vertex, in bytes. | 
|---|
 | 103 |         btScalar             mNormalEpsilon;   // the epsilon for removing duplicates.  This is a normalized value, if normalized bit is on. | 
|---|
 | 104 |         unsigned int      mMaxVertices;     // maximum number of vertices to be considered for the hull! | 
|---|
 | 105 |         unsigned int      mMaxFaces; | 
|---|
 | 106 | }; | 
|---|
 | 107 |  | 
|---|
 | 108 | enum HullError | 
|---|
 | 109 | { | 
|---|
 | 110 |         QE_OK,            // success! | 
|---|
 | 111 |         QE_FAIL           // failed. | 
|---|
 | 112 | }; | 
|---|
 | 113 |  | 
|---|
 | 114 | class btPlane | 
|---|
 | 115 | { | 
|---|
 | 116 |         public: | 
|---|
 | 117 |         btVector3       normal; | 
|---|
 | 118 |         btScalar        dist;   // distance below origin - the D from plane equasion Ax+By+Cz+D=0 | 
|---|
 | 119 |                         btPlane(const btVector3 &n,btScalar d):normal(n),dist(d){} | 
|---|
 | 120 |                         btPlane():normal(),dist(0){} | 
|---|
 | 121 |          | 
|---|
 | 122 | }; | 
|---|
 | 123 |  | 
|---|
 | 124 |  | 
|---|
 | 125 |  | 
|---|
 | 126 | class ConvexH  | 
|---|
 | 127 | { | 
|---|
 | 128 |   public: | 
|---|
 | 129 |         class HalfEdge | 
|---|
 | 130 |         { | 
|---|
 | 131 |           public: | 
|---|
 | 132 |                 short ea;         // the other half of the edge (index into edges list) | 
|---|
 | 133 |                 unsigned char v;  // the vertex at the start of this edge (index into vertices list) | 
|---|
 | 134 |                 unsigned char p;  // the facet on which this edge lies (index into facets list) | 
|---|
 | 135 |                 HalfEdge(){} | 
|---|
 | 136 |                 HalfEdge(short _ea,unsigned char _v, unsigned char _p):ea(_ea),v(_v),p(_p){} | 
|---|
 | 137 |         }; | 
|---|
 | 138 |         ConvexH() | 
|---|
 | 139 |         { | 
|---|
 | 140 |         } | 
|---|
 | 141 |         ~ConvexH() | 
|---|
 | 142 |         { | 
|---|
 | 143 |         } | 
|---|
 | 144 |         btAlignedObjectArray<btVector3> vertices; | 
|---|
 | 145 |         btAlignedObjectArray<HalfEdge> edges; | 
|---|
 | 146 |         btAlignedObjectArray<btPlane>  facets; | 
|---|
 | 147 |         ConvexH(int vertices_size,int edges_size,int facets_size); | 
|---|
 | 148 | }; | 
|---|
 | 149 |  | 
|---|
 | 150 |  | 
|---|
 | 151 | class int4 | 
|---|
 | 152 | { | 
|---|
 | 153 | public: | 
|---|
 | 154 |         int x,y,z,w; | 
|---|
 | 155 |         int4(){}; | 
|---|
 | 156 |         int4(int _x,int _y, int _z,int _w){x=_x;y=_y;z=_z;w=_w;} | 
|---|
 | 157 |         const int& operator[](int i) const {return (&x)[i];} | 
|---|
 | 158 |         int& operator[](int i) {return (&x)[i];} | 
|---|
 | 159 | }; | 
|---|
 | 160 |  | 
|---|
 | 161 | class PHullResult | 
|---|
 | 162 | { | 
|---|
 | 163 | public: | 
|---|
 | 164 |  | 
|---|
 | 165 |         PHullResult(void) | 
|---|
 | 166 |         { | 
|---|
 | 167 |                 mVcount = 0; | 
|---|
 | 168 |                 mIndexCount = 0; | 
|---|
 | 169 |                 mFaceCount = 0; | 
|---|
 | 170 |                 mVertices = 0; | 
|---|
 | 171 |         } | 
|---|
 | 172 |  | 
|---|
 | 173 |         unsigned int mVcount; | 
|---|
 | 174 |         unsigned int mIndexCount; | 
|---|
 | 175 |         unsigned int mFaceCount; | 
|---|
 | 176 |         btVector3*   mVertices; | 
|---|
 | 177 |         TUIntArray m_Indices; | 
|---|
 | 178 | }; | 
|---|
 | 179 |  | 
|---|
 | 180 |  | 
|---|
 | 181 |  | 
|---|
 | 182 | ///The HullLibrary class can create a convex hull from a collection of vertices, using the ComputeHull method. | 
|---|
 | 183 | ///The btShapeHull class uses this HullLibrary to create a approximate convex mesh given a general (non-polyhedral) convex shape. | 
|---|
 | 184 | class HullLibrary | 
|---|
 | 185 | { | 
|---|
 | 186 |  | 
|---|
| [2430] | 187 |         btAlignedObjectArray<class btHullTriangle*> m_tris; | 
|---|
| [1963] | 188 |  | 
|---|
 | 189 | public: | 
|---|
 | 190 |  | 
|---|
 | 191 |         btAlignedObjectArray<int> m_vertexIndexMapping; | 
|---|
 | 192 |  | 
|---|
 | 193 |  | 
|---|
 | 194 |         HullError CreateConvexHull(const HullDesc& desc, // describes the input request | 
|---|
 | 195 |                                    HullResult&     result);        // contains the resulst | 
|---|
 | 196 |         HullError ReleaseResult(HullResult &result); // release memory allocated for this result, we are done with it. | 
|---|
 | 197 |  | 
|---|
 | 198 | private: | 
|---|
 | 199 |  | 
|---|
 | 200 |         bool ComputeHull(unsigned int vcount,const btVector3 *vertices,PHullResult &result,unsigned int vlimit); | 
|---|
 | 201 |  | 
|---|
| [2430] | 202 |         class btHullTriangle*   allocateTriangle(int a,int b,int c); | 
|---|
 | 203 |         void    deAllocateTriangle(btHullTriangle*); | 
|---|
 | 204 |         void b2bfix(btHullTriangle* s,btHullTriangle*t); | 
|---|
| [1963] | 205 |  | 
|---|
| [2430] | 206 |         void removeb2b(btHullTriangle* s,btHullTriangle*t); | 
|---|
| [1963] | 207 |  | 
|---|
| [2430] | 208 |         void checkit(btHullTriangle *t); | 
|---|
| [1963] | 209 |  | 
|---|
| [2430] | 210 |         btHullTriangle* extrudable(btScalar epsilon); | 
|---|
| [1963] | 211 |  | 
|---|
 | 212 |         int calchull(btVector3 *verts,int verts_count, TUIntArray& tris_out, int &tris_count,int vlimit); | 
|---|
 | 213 |  | 
|---|
 | 214 |         int calchullgen(btVector3 *verts,int verts_count, int vlimit); | 
|---|
 | 215 |  | 
|---|
 | 216 |         int4 FindSimplex(btVector3 *verts,int verts_count,btAlignedObjectArray<int> &allow); | 
|---|
 | 217 |  | 
|---|
 | 218 |         class ConvexH* ConvexHCrop(ConvexH& convex,const btPlane& slice); | 
|---|
 | 219 |  | 
|---|
| [2430] | 220 |         void extrude(class btHullTriangle* t0,int v); | 
|---|
| [1963] | 221 |  | 
|---|
 | 222 |         ConvexH* test_cube(); | 
|---|
 | 223 |  | 
|---|
 | 224 |         //BringOutYourDead (John Ratcliff): When you create a convex hull you hand it a large input set of vertices forming a 'point cloud'.  | 
|---|
 | 225 |         //After the hull is generated it give you back a set of polygon faces which index the *original* point cloud. | 
|---|
 | 226 |         //The thing is, often times, there are many 'dead vertices' in the point cloud that are on longer referenced by the hull. | 
|---|
 | 227 |         //The routine 'BringOutYourDead' find only the referenced vertices, copies them to an new buffer, and re-indexes the hull so that it is a minimal representation. | 
|---|
 | 228 |         void BringOutYourDead(const btVector3* verts,unsigned int vcount, btVector3* overts,unsigned int &ocount,unsigned int* indices,unsigned indexcount); | 
|---|
 | 229 |  | 
|---|
 | 230 |         bool CleanupVertices(unsigned int svcount, | 
|---|
 | 231 |                              const btVector3* svertices, | 
|---|
 | 232 |                              unsigned int stride, | 
|---|
 | 233 |                              unsigned int &vcount, // output number of vertices | 
|---|
 | 234 |                              btVector3* vertices, // location to store the results. | 
|---|
 | 235 |                              btScalar  normalepsilon, | 
|---|
 | 236 |                              btVector3& scale); | 
|---|
 | 237 | }; | 
|---|
 | 238 |  | 
|---|
 | 239 |  | 
|---|
 | 240 | #endif | 
|---|
 | 241 |  | 
|---|