Advertisement
Guest User

Untitled

a guest
Feb 10th, 2015
323
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.58 KB | None | 0 0
  1.     inline void ReplaceAdd(const CM_MANIFOLD_CONTACT& _cNewContact) {
  2.         float fMinDist = CONTACT_POINT_BREAKING_LENGTH_SQ;
  3.         int iReplaceIndex = -1;
  4.         for (unsigned int I = 0U; I < m_ui32TotalContacts; ++I) {
  5.             const CM_MANIFOLD_CONTACT& cContact = m_cContacts[I];
  6.             CVector3 vDiff = cContact.vLocalPointOnA - _cNewContact.vLocalPointOnA;
  7.             float fDist = vDiff.LenSq();
  8.             if ( fDist < fMinDist ) {
  9.                 fMinDist = fDist;
  10.                 iReplaceIndex = I;
  11.             }
  12.         }
  13.  
  14.         if (iReplaceIndex > -1) {
  15.             ReplaceContact(_cNewContact, iReplaceIndex);
  16.             return;
  17.         }
  18.        
  19.         AddContact(_cNewContact);
  20.     }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement