DART 6.10.1
Loading...
Searching...
No Matches
ConstraintBase.hpp
Go to the documentation of this file.
1/*
2 * Copyright (c) 2011-2021, 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
40namespace dart {
41
42namespace dynamics {
43class Skeleton;
44} // namespace dynamics
45
46namespace 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
71};
72
75{
76public:
78 virtual const std::string& getType() const;
79
81 std::size_t getDimension() const;
82
84 virtual void update() = 0;
85
87 virtual void getInformation(ConstraintInfo* info) = 0;
88
90 virtual void applyUnitImpulse(std::size_t index) = 0;
91
93 virtual void getVelocityChange(double* vel, bool withCfm) = 0;
94
96 virtual void excite() = 0;
97
99 virtual void unexcite() = 0;
100
102 virtual void applyImpulse(double* lambda) = 0;
103
105 virtual bool isActive() const = 0;
106
109
111 virtual void uniteSkeletons();
112
115
118
119 //----------------------------------------------------------------------------
120 // Friendship
121 //----------------------------------------------------------------------------
122
123 friend class ConstraintSolver;
124 friend class ConstrainedGroup;
125
127 virtual ~ConstraintBase();
128
129protected:
132
133protected:
135 std::size_t mDim;
136};
137
138} // namespace constraint
139} // namespace dart
140
141#endif // DART_CONSTRAINT_CONSTRAINTBASE_HPP_
std::size_t index
Definition SkelParser.cpp:1672
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:64
std::size_t mDim
Dimension of constraint.
Definition ConstraintBase.hpp:135
virtual ~ConstraintBase()
Destructor.
Definition ConstraintBase.cpp:47
virtual void applyImpulse(double *lambda)=0
Apply computed constraint impulse to constrained skeletons.
virtual void getInformation(ConstraintInfo *info)=0
Fill LCP variables.
virtual dynamics::SkeletonPtr getRootSkeleton() const =0
virtual const std::string & getType() const
Returns a string representing the constraint type.
Definition ConstraintBase.cpp:53
virtual void getVelocityChange(double *vel, bool withCfm)=0
Get velocity change due to the uint impulse.
virtual void uniteSkeletons()
Definition ConstraintBase.cpp:70
ConstraintBase()
Default contructor.
Definition ConstraintBase.cpp:41
virtual bool isActive() const =0
Return true if this constraint is active.
virtual void applyUnitImpulse(std::size_t index)=0
Apply unit impulse to constraint space.
static dynamics::SkeletonPtr compressPath(dynamics::SkeletonPtr skeleton)
Definition ConstraintBase.cpp:76
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:57
std::shared_ptr< Skeleton > SkeletonPtr
Definition SmartPointer.hpp:60
Definition BulletCollisionDetector.cpp:65
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