DART  6.6.2
ConstraintBase.hpp
Go to the documentation of this file.
1 /*
2  * Copyright (c) 2011-2018, The DART development contributors
3  * All rights reserved.
4  *
5  * The list of contributors can be found at:
6  * https://github.com/dartsim/dart/blob/master/LICENSE
7  *
8  * This file is provided under the following "BSD-style" License:
9  * Redistribution and use in source and binary forms, with or
10  * without modification, are permitted provided that the following
11  * conditions are met:
12  * * Redistributions of source code must retain the above copyright
13  * notice, this list of conditions and the following disclaimer.
14  * * Redistributions in binary form must reproduce the above
15  * copyright notice, this list of conditions and the following
16  * disclaimer in the documentation and/or other materials provided
17  * with the distribution.
18  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
19  * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
20  * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
21  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
22  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
23  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
24  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
25  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
26  * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
27  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30  * POSSIBILITY OF SUCH DAMAGE.
31  */
32 
33 #ifndef DART_CONSTRAINT_CONSTRAINTBASE_HPP_
34 #define DART_CONSTRAINT_CONSTRAINTBASE_HPP_
35 
36 #include <cstddef>
37 
39 
40 namespace dart {
41 
42 namespace dynamics {
43 class Skeleton;
44 } // namespace dynamics
45 
46 namespace constraint {
47 
50 {
52  double* x;
53 
55  double* lo;
56 
58  double* hi;
59 
61  double* b;
62 
64  double* w;
65 
67  int* findex;
68 
70  double invTimeStep;
71 };
72 
75 {
76 public:
78  std::size_t getDimension() const;
79 
81  virtual void update() = 0;
82 
84  virtual void getInformation(ConstraintInfo* _info) = 0;
85 
87  virtual void applyUnitImpulse(std::size_t _index) = 0;
88 
90  virtual void getVelocityChange(double* _vel, bool _withCfm) = 0;
91 
93  virtual void excite() = 0;
94 
96  virtual void unexcite() = 0;
97 
99  virtual void applyImpulse(double* _lambda) = 0;
100 
102  virtual bool isActive() const = 0;
103 
106 
108  virtual void uniteSkeletons();
109 
112 
115 
116  //----------------------------------------------------------------------------
117  // Friendship
118  //----------------------------------------------------------------------------
119 
120  friend class ConstraintSolver;
121  friend class ConstrainedGroup;
122 
123 protected:
125  ConstraintBase();
126 
128  virtual ~ConstraintBase();
129 
130 protected:
132  std::size_t mDim;
133 };
134 
135 } // namespace constraint
136 } // namespace dart
137 
138 #endif // DART_CONSTRAINT_CONSTRAINTBASE_HPP_
139 
ConstrainedGroup is a group of skeletons that interact each other with constraints.
Definition: ConstrainedGroup.hpp:58
Constraint is a base class of concrete constraints classes.
Definition: ConstraintBase.hpp:75
std::size_t getDimension() const
Return dimesion of this constranit.
Definition: ConstraintBase.cpp:57
virtual void getInformation(ConstraintInfo *_info)=0
Fill LCP variables.
static dynamics::SkeletonPtr compressPath(dynamics::SkeletonPtr _skeleton)
Definition: ConstraintBase.cpp:69
std::size_t mDim
Dimension of constraint.
Definition: ConstraintBase.hpp:132
virtual ~ConstraintBase()
Destructor.
Definition: ConstraintBase.cpp:52
virtual void getVelocityChange(double *_vel, bool _withCfm)=0
Get velocity change due to the uint impulse.
virtual void applyImpulse(double *_lambda)=0
Apply computed constraint impulse to constrained skeletons.
virtual void applyUnitImpulse(std::size_t _index)=0
Apply unit impulse to constraint space.
virtual dynamics::SkeletonPtr getRootSkeleton() const =0
virtual void uniteSkeletons()
Definition: ConstraintBase.cpp:63
ConstraintBase()
Default contructor.
Definition: ConstraintBase.cpp:46
virtual bool isActive() const =0
Return true if this constraint is active.
virtual void unexcite()=0
Unexcite the constraint.
virtual void update()=0
Update constraint using updated Skeleton's states.
virtual void excite()=0
Excite the constraint.
ConstraintSolver manages constraints and computes constraint impulses.
Definition: ConstraintSolver.hpp:56
std::shared_ptr< Skeleton > SkeletonPtr
Definition: SmartPointer.hpp:60
Definition: BulletCollisionDetector.cpp:63
ConstraintInfo.
Definition: ConstraintBase.hpp:50
double * w
Slack variable.
Definition: ConstraintBase.hpp:64
int * findex
Friction index.
Definition: ConstraintBase.hpp:67
double invTimeStep
Inverse of time step.
Definition: ConstraintBase.hpp:70
double * hi
Upper bound of x.
Definition: ConstraintBase.hpp:58
double * b
Bias term.
Definition: ConstraintBase.hpp:61
double * x
Impulse.
Definition: ConstraintBase.hpp:52
double * lo
Lower bound of x.
Definition: ConstraintBase.hpp:55