b2ContactSolver.h 2.4 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495
  1. /*
  2. * Copyright (c) 2006-2009 Erin Catto http://www.box2d.org
  3. *
  4. * This software is provided 'as-is', without any express or implied
  5. * warranty. In no event will the authors be held liable for any damages
  6. * arising from the use of this software.
  7. * Permission is granted to anyone to use this software for any purpose,
  8. * including commercial applications, and to alter it and redistribute it
  9. * freely, subject to the following restrictions:
  10. * 1. The origin of this software must not be misrepresented; you must not
  11. * claim that you wrote the original software. If you use this software
  12. * in a product, an acknowledgment in the product documentation would be
  13. * appreciated but is not required.
  14. * 2. Altered source versions must be plainly marked as such, and must not be
  15. * misrepresented as being the original software.
  16. * 3. This notice may not be removed or altered from any source distribution.
  17. */
  18. #ifndef B2_CONTACT_SOLVER_H
  19. #define B2_CONTACT_SOLVER_H
  20. #include <Box2D/Common/b2Math.h>
  21. #include <Box2D/Collision/b2Collision.h>
  22. #include <Box2D/Dynamics/b2TimeStep.h>
  23. class b2Contact;
  24. class b2Body;
  25. class b2StackAllocator;
  26. struct b2ContactPositionConstraint;
  27. struct b2VelocityConstraintPoint
  28. {
  29. b2Vec2 rA;
  30. b2Vec2 rB;
  31. float32 normalImpulse;
  32. float32 tangentImpulse;
  33. float32 normalMass;
  34. float32 tangentMass;
  35. float32 velocityBias;
  36. };
  37. struct b2ContactVelocityConstraint
  38. {
  39. b2VelocityConstraintPoint points[b2_maxManifoldPoints];
  40. b2Vec2 normal;
  41. b2Mat22 normalMass;
  42. b2Mat22 K;
  43. int32 indexA;
  44. int32 indexB;
  45. float32 invMassA, invMassB;
  46. float32 invIA, invIB;
  47. float32 friction;
  48. float32 restitution;
  49. float32 tangentSpeed;
  50. int32 pointCount;
  51. int32 contactIndex;
  52. };
  53. struct b2ContactSolverDef
  54. {
  55. b2TimeStep step;
  56. b2Contact** contacts;
  57. int32 count;
  58. b2Position* positions;
  59. b2Velocity* velocities;
  60. b2StackAllocator* allocator;
  61. };
  62. class b2ContactSolver
  63. {
  64. public:
  65. b2ContactSolver(b2ContactSolverDef* def);
  66. ~b2ContactSolver();
  67. void InitializeVelocityConstraints();
  68. void WarmStart();
  69. void SolveVelocityConstraints();
  70. void StoreImpulses();
  71. bool SolvePositionConstraints();
  72. bool SolveTOIPositionConstraints(int32 toiIndexA, int32 toiIndexB);
  73. b2TimeStep m_step;
  74. b2Position* m_positions;
  75. b2Velocity* m_velocities;
  76. b2StackAllocator* m_allocator;
  77. b2ContactPositionConstraint* m_positionConstraints;
  78. b2ContactVelocityConstraint* m_velocityConstraints;
  79. b2Contact** m_contacts;
  80. int m_count;
  81. };
  82. #endif