|
2 | 2 | #define _CONSTRAINTS_H |
3 | 3 |
|
4 | 4 | #include "Common/Common.h" |
| 5 | +#define _USE_MATH_DEFINES |
| 6 | +#include "math.h" |
5 | 7 |
|
6 | 8 | namespace PBD |
7 | 9 | { |
@@ -46,46 +48,46 @@ namespace PBD |
46 | 48 | }; |
47 | 49 |
|
48 | 50 | class BallOnLineJoint : public Constraint |
49 | | - { |
| 51 | + { |
50 | 52 | public: |
51 | 53 | static int TYPE_ID; |
52 | 54 | Eigen::Matrix<Real, 3, 10> m_jointInfo; |
53 | 55 |
|
54 | 56 | BallOnLineJoint() : Constraint(2) {} |
55 | | - virtual int &getTypeId() const { return TYPE_ID; } |
| 57 | + virtual int &getTypeId() const { return TYPE_ID; } |
56 | 58 |
|
57 | 59 | bool initConstraint(SimulationModel &model, const unsigned int rbIndex1, const unsigned int rbIndex2, const Vector3r &pos, const Vector3r &dir); |
58 | 60 | virtual bool updateConstraint(SimulationModel &model); |
59 | 61 | virtual bool solvePositionConstraint(SimulationModel &model); |
60 | | - }; |
| 62 | + }; |
61 | 63 |
|
62 | 64 | class HingeJoint : public Constraint |
63 | | - { |
| 65 | + { |
64 | 66 | public: |
65 | 67 | static int TYPE_ID; |
66 | | - Eigen::Matrix<Real, 3, 12> m_jointInfo; |
| 68 | + Eigen::Matrix<Real, 3, 12> m_jointInfo; |
67 | 69 |
|
68 | 70 | HingeJoint() : Constraint(2) {} |
69 | | - virtual int &getTypeId() const { return TYPE_ID; } |
| 71 | + virtual int &getTypeId() const { return TYPE_ID; } |
70 | 72 |
|
71 | 73 | bool initConstraint(SimulationModel &model, const unsigned int rbIndex1, const unsigned int rbIndex2, const Vector3r &pos, const Vector3r &axis); |
72 | 74 | virtual bool updateConstraint(SimulationModel &model); |
73 | 75 | virtual bool solvePositionConstraint(SimulationModel &model); |
74 | | - }; |
| 76 | + }; |
75 | 77 |
|
76 | 78 | class UniversalJoint : public Constraint |
77 | | - { |
| 79 | + { |
78 | 80 | public: |
79 | 81 | static int TYPE_ID; |
80 | | - Eigen::Matrix<Real, 3, 8> m_jointInfo; |
| 82 | + Eigen::Matrix<Real, 3, 8> m_jointInfo; |
81 | 83 |
|
82 | 84 | UniversalJoint() : Constraint(2) {} |
83 | | - virtual int &getTypeId() const { return TYPE_ID; } |
| 85 | + virtual int &getTypeId() const { return TYPE_ID; } |
84 | 86 |
|
85 | 87 | bool initConstraint(SimulationModel &model, const unsigned int rbIndex1, const unsigned int rbIndex2, const Vector3r &pos, const Vector3r &axis1, const Vector3r &axis2); |
86 | 88 | virtual bool updateConstraint(SimulationModel &model); |
87 | 89 | virtual bool solvePositionConstraint(SimulationModel &model); |
88 | | - }; |
| 90 | + }; |
89 | 91 |
|
90 | 92 | class SliderJoint : public Constraint |
91 | 93 | { |
@@ -179,18 +181,18 @@ namespace PBD |
179 | 181 | }; |
180 | 182 |
|
181 | 183 | class RigidBodyParticleBallJoint : public Constraint |
182 | | - { |
| 184 | + { |
183 | 185 | public: |
184 | 186 | static int TYPE_ID; |
185 | | - Eigen::Matrix<Real, 3, 2> m_jointInfo; |
| 187 | + Eigen::Matrix<Real, 3, 2> m_jointInfo; |
186 | 188 |
|
187 | 189 | RigidBodyParticleBallJoint() : Constraint(2) {} |
188 | | - virtual int &getTypeId() const { return TYPE_ID; } |
| 190 | + virtual int &getTypeId() const { return TYPE_ID; } |
189 | 191 |
|
190 | 192 | bool initConstraint(SimulationModel &model, const unsigned int rbIndex, const unsigned int particleIndex); |
191 | 193 | virtual bool updateConstraint(SimulationModel &model); |
192 | 194 | virtual bool solvePositionConstraint(SimulationModel &model); |
193 | | - }; |
| 195 | + }; |
194 | 196 |
|
195 | 197 | class DistanceConstraint : public Constraint |
196 | 198 | { |
|
0 commit comments