Add the class Contact that contains the contact points between two bodies

src/engine/ConstraintSolver.cpp

@@ -49,14 +49,20 @@ void ConstraintSolver::initialize() {
     nbConstraints = 0;
 
     // TOOD : Use better allocation here
-    mContactConstraints = new ContactConstraint[world->getNbContactConstraints()];
+    mContactConstraints = new ContactConstraint[world->getNbContactManifolds()];
 
     uint nbContactConstraints = 0;
 
-    // For each constraint
-    vector<Contact*>::iterator it;
-    for (it = world->getContactConstraintsBeginIterator(); it != world->getContactConstraintsEndIterator(); ++it) {
-        Contact* contact = *it;
+    // For each contact manifold of the world
+    vector<ContactManifold>::iterator it;
+    for (it = world->getContactManifoldsBeginIterator(); it != world->getContactManifoldsEndIterator(); ++it) {
+        ContactManifold contactManifold = *it;
+
+        // For each contact point of the contact manifold
+        for (uint c=0; c<contactManifold.nbContacts; c++) {
+
+            // Get a contact point
+            Contact* contact = contactManifold.contacts[c];
 
             // If the constraint is active
             if (contact->isActive()) {
@@ -89,6 +95,8 @@ void ConstraintSolver::initialize() {
 
                 nbContactConstraints++;
             }
+
+        }
     }
 
     // Compute the number of bodies that are part of some active constraint

src/engine/DynamicsWorld.cpp

@@ -50,7 +50,6 @@ DynamicsWorld::~DynamicsWorld() {
 
 // Update the physics simulation
 void DynamicsWorld::update() {
-    bool existCollision = false;
 
     assert(mTimer.getIsRunning());
     
@@ -63,16 +62,16 @@ void DynamicsWorld::update() {
     // While the time accumulator is not empty
     while(mTimer.isPossibleToTakeStep()) {
 
-        existCollision = false;
-
-        // Remove all contact constraints
-        mContactConstraints.clear();
+        // Remove all contact manifolds
+        mContactManifolds.clear();
 		
         // Compute the collision detection
-        if (mCollisionDetection.computeCollisionDetection()) {
-            existCollision = true;
+        mCollisionDetection.computeCollisionDetection();
 
-            // Solve constraints
+        // If there are constraints or contacts
+        if (!mConstraints.empty() || !mContactManifolds.empty()) {
+
+            // Solve the constraints and contacts
             mConstraintSolver.solve(mTimer.getTimeStep());
         }
 
@@ -86,10 +85,8 @@ void DynamicsWorld::update() {
         updateAllBodiesMotion();
 
         // Cleanup of the constraint solver
-        if (existCollision) {
         mConstraintSolver.cleanup();
     }
-    }
 
     // Compute and set the interpolation factor to all the bodies
     setInterpolationFactorToAllBodies();
@@ -302,9 +299,17 @@ void DynamicsWorld::notifyNewContact(const BroadPhasePair* broadPhasePair, const
     // Add the contact to the contact cache of the corresponding overlapping pair
     overlappingPair->addContact(contact);
 
+    // Create a contact manifold with the contact points of the two bodies
+    ContactManifold contactManifold;
+    contactManifold.nbContacts = 0;
+
     // Add all the contacts in the contact cache of the two bodies
     // to the set of constraints in the physics world
     for (uint i=0; i<overlappingPair->getNbContacts(); i++) {
-        mContactConstraints.push_back(overlappingPair->getContact(i));
+        contactManifold.contacts[i] = overlappingPair->getContact(i);
+        contactManifold.nbContacts++;
     }
+
+    // Add the contact manifold to the world
+    mContactManifolds.push_back(contactManifold);
 }

src/engine/DynamicsWorld.h

@@ -28,6 +28,7 @@
 
 // Libraries
 #include "CollisionWorld.h"
+#include "ContactManifold.h"
 #include "../collision/CollisionDetection.h"
 #include "ConstraintSolver.h"
 #include "../body/RigidBody.h"
@@ -63,7 +64,7 @@ class DynamicsWorld : public CollisionWorld {
         std::set<RigidBody*> mRigidBodies;
 
         // All the contact constraints
-        std::vector<Contact*> mContactConstraints;
+        std::vector<ContactManifold> mContactManifolds;
 
         // All the constraints (except contact constraints)
         std::vector<Constraint*> mConstraints;
@@ -171,7 +172,7 @@ public :
         void removeAllConstraints();
 
         // Return the number of contact constraints in the world
-        uint getNbContactConstraints() const;
+        uint getNbContactManifolds() const;
 
         // Return a start iterator on the constraint list
         std::vector<Constraint*>::iterator getConstraintsBeginIterator();
@@ -179,11 +180,11 @@ public :
         // Return a end iterator on the constraint list
         std::vector<Constraint*>::iterator getConstraintsEndIterator();
 
-        // Return a start iterator on the contact constraint list
-        std::vector<Contact*>::iterator getContactConstraintsBeginIterator();
+        // Return a start iterator on the contact manifolds list
+        std::vector<ContactManifold>::iterator getContactManifoldsBeginIterator();
 
-        // Return a end iterator on the contact constraint list
-        std::vector<Contact*>::iterator getContactConstraintsEndIterator();
+        // Return a end iterator on the contact manifolds list
+        std::vector<ContactManifold>::iterator getContactManifoldsEndIterator();
 
         // Return an iterator to the beginning of the rigid bodies of the physics world
         std::set<RigidBody*>::iterator getRigidBodiesBeginIterator();
@@ -277,9 +278,9 @@ inline std::set<RigidBody*>::iterator DynamicsWorld::getRigidBodiesEndIterator()
     return mRigidBodies.end();
 }
 
-// Return the number of contact constraints in the world
-inline uint DynamicsWorld::getNbContactConstraints() const {
-    return mContactConstraints.size();
+// Return the number of contact manifolds in the world
+inline uint DynamicsWorld::getNbContactManifolds() const {
+    return mContactManifolds.size();
 }
 
 // Return a start iterator on the constraint list
@@ -292,14 +293,14 @@ inline std::vector<Constraint*>::iterator DynamicsWorld::getConstraintsEndIterat
     return mConstraints.end();
 }
 
-// Return a start iterator on the contact constraint list
-inline std::vector<Contact*>::iterator DynamicsWorld::getContactConstraintsBeginIterator() {
-    return mContactConstraints.begin();
+// Return a start iterator on the contact manifolds list
+inline std::vector<ContactManifold>::iterator DynamicsWorld::getContactManifoldsBeginIterator() {
+    return mContactManifolds.begin();
 }
 
-// Return a end iterator on the contact constraint list
-inline std::vector<Contact*>::iterator DynamicsWorld::getContactConstraintsEndIterator() {
-    return mContactConstraints.end();
+// Return a end iterator on the contact manifolds list
+inline std::vector<ContactManifold>::iterator DynamicsWorld::getContactManifoldsEndIterator() {
+    return mContactManifolds.end();
 }
 
 }