CcdCollisionLoop.h
Go to the documentation of this file.
1 // This file is a part of the OpenSurgSim project.
2 // Copyright 2013-2016, SimQuest Solutions Inc.
3 //
4 // Licensed under the Apache License, Version 2.0 (the "License");
5 // you may not use this file except in compliance with the License.
6 // You may obtain a copy of the License at
7 //
8 // http://www.apache.org/licenses/LICENSE-2.0
9 //
10 // Unless required by applicable law or agreed to in writing, software
11 // distributed under the License is distributed on an "AS IS" BASIS,
12 // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 // See the License for the specific language governing permissions and
14 // limitations under the License.
15 
16 #ifndef SURGSIM_PHYSICS_CCDCOLLISIONLOOP_H
17 #define SURGSIM_PHYSICS_CCDCOLLISIONLOOP_H
18 
20 
21 namespace SurgSim
22 {
23 
24 namespace Framework
25 {
26 class Logger;
27 }
28 
29 namespace Collision
30 {
31 class CollisionPair;
32 struct Contact;
33 }
34 namespace Physics
35 {
36 
37 class CcdCollision;
38 class ContactFiltering;
39 class UpdateCcdData;
40 class ContactConstraintGeneration;
41 class BuildMlcp;
42 class SolveMlcp;
43 class PushResults;
44 class PhysicsManager;
45 
47 {
48 public:
49 
51  explicit CcdCollisionLoop(bool copyState);
52 
55 
57 
58  std::shared_ptr<PhysicsManagerState> doUpdate(const double& dt,
59  const std::shared_ptr<PhysicsManagerState>& state) override;
60 
63  friend class CcdCollisionLoopTest_FilterContacts_Test;
64  friend class CcdCollisionLoopTest_FilterContactsWithEpsilon_Test;
66 
67 private:
70  std::unique_ptr<CcdCollision> m_ccdCollision;
71  std::unique_ptr<UpdateCcdData> m_updateCcdData;
72  std::unique_ptr<ContactFiltering> m_contactFilter;
73  std::unique_ptr<ContactConstraintGeneration> m_constraintGeneration;
74  std::unique_ptr<BuildMlcp> m_buildMlcp;
75  std::unique_ptr<SolveMlcp> m_solveMlcp;
76  std::unique_ptr<PushResults> m_pushResults;
78 
79  size_t m_maxIterations;
80 
85 
90  bool findEarliestContact(const std::vector<std::shared_ptr<Collision::CollisionPair>>& ccdPairs,
91  double* currentTimeOfImpact);
92 
97  void filterLaterContacts(std::vector<std::shared_ptr<Collision::CollisionPair>>* ccdPairs,
98  double epsilon,
99  double contactTime);
100 
104  void backupContacts(std::vector<std::shared_ptr<Collision::CollisionPair>>* ccdPairs,
105  std::vector<std::list<std::shared_ptr<Collision::Contact>>>* oldContacts);
106 
111  void restoreContacts(std::vector<std::shared_ptr<Collision::CollisionPair>>* ccdPairs,
112  std::vector<std::list<std::shared_ptr<Collision::Contact>>>* oldContacts);
113 
116  void printContacts(const std::vector<std::shared_ptr<Collision::CollisionPair>>& ccdPairs);
117 
118  std::shared_ptr<SurgSim::Framework::Logger> m_logger;
119 };
120 
121 }
122 }
123 
124 #endif
size_t m_maxIterations
maximum number of iterations to run
Definition: CcdCollisionLoop.h:79
std::unique_ptr< ContactConstraintGeneration > m_constraintGeneration
Definition: CcdCollisionLoop.h:73
Definition: CompoundShapeToGraphics.cpp:29
std::unique_ptr< PushResults > m_pushResults
Definition: CcdCollisionLoop.h:76
Definition: CcdCollisionLoop.h:46
std::unique_ptr< UpdateCcdData > m_updateCcdData
Definition: CcdCollisionLoop.h:71
#define SURGSIM_CLASSNAME(ClassName)
Declare the class name of a class with the appropriate function header, do not use quotes...
Definition: Macros.h:21
std::unique_ptr< SolveMlcp > m_solveMlcp
Definition: CcdCollisionLoop.h:75
std::shared_ptr< SurgSim::Framework::Logger > m_logger
Definition: CcdCollisionLoop.h:118
std::unique_ptr< CcdCollision > m_ccdCollision
Definition: CcdCollisionLoop.h:70
Encapsulates a calculation over a selection of objects, needs to be subclassed to be used...
Definition: Computation.h:32
std::unique_ptr< ContactFiltering > m_contactFilter
Definition: CcdCollisionLoop.h:72
std::unique_ptr< BuildMlcp > m_buildMlcp
Definition: CcdCollisionLoop.h:74
double m_epsilonFactor
epsilon as a fraction of dt, i.e.
Definition: CcdCollisionLoop.h:84