123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081 |
- /*
- Bullet Continuous Collision Detection and Physics Library
- Copyright (c) 2003-2013 Erwin Coumans http://bulletphysics.org
- 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.
- */
- ///original version written by Erwin Coumans, October 2013
- #ifndef BT_MLCP_SOLVER_H
- #define BT_MLCP_SOLVER_H
- #include "bullet/BulletDynamics/ConstraintSolver/btSequentialImpulseConstraintSolver.h"
- #include "bullet/LinearMath/btMatrixX.h"
- #include "bullet/BulletDynamics/MLCPSolvers/btMLCPSolverInterface.h"
- class btMLCPSolver : public btSequentialImpulseConstraintSolver
- {
- protected:
-
- btMatrixXu m_A;
- btVectorXu m_b;
- btVectorXu m_x;
- btVectorXu m_lo;
- btVectorXu m_hi;
-
- ///when using 'split impulse' we solve two separate (M)LCPs
- btVectorXu m_bSplit;
- btVectorXu m_xSplit;
- btVectorXu m_bSplit1;
- btVectorXu m_xSplit2;
- btAlignedObjectArray<int> m_limitDependencies;
- btConstraintArray m_allConstraintArray;
- btMLCPSolverInterface* m_solver;
- int m_fallback;
- virtual btScalar solveGroupCacheFriendlySetup(btCollisionObject** bodies, int numBodies, btPersistentManifold** manifoldPtr, int numManifolds,btTypedConstraint** constraints,int numConstraints,const btContactSolverInfo& infoGlobal,btIDebugDraw* debugDrawer);
- virtual btScalar solveGroupCacheFriendlyIterations(btCollisionObject** bodies ,int numBodies,btPersistentManifold** manifoldPtr, int numManifolds,btTypedConstraint** constraints,int numConstraints,const btContactSolverInfo& infoGlobal,btIDebugDraw* debugDrawer);
- virtual void createMLCP(const btContactSolverInfo& infoGlobal);
- virtual void createMLCPFast(const btContactSolverInfo& infoGlobal);
- //return true is it solves the problem successfully
- virtual bool solveMLCP(const btContactSolverInfo& infoGlobal);
- public:
- btMLCPSolver( btMLCPSolverInterface* solver);
- virtual ~btMLCPSolver();
- void setMLCPSolver(btMLCPSolverInterface* solver)
- {
- m_solver = solver;
- }
- int getNumFallbacks() const
- {
- return m_fallback;
- }
- void setNumFallbacks(int num)
- {
- m_fallback = num;
- }
- virtual btConstraintSolverType getSolverType() const
- {
- return BT_MLCP_SOLVER;
- }
- };
- #endif //BT_MLCP_SOLVER_H
|