20 #ifndef _DYNAMIC_SYSTEM_SOLVER_H_
21 #define _DYNAMIC_SYSTEM_SOLVER_H_
23 #include "mbsim/group.h"
24 #include "fmatvec/sparse_matrix.h"
25 #include "mbsim/functions/function.h"
26 #include "mbsim/environment.h"
33 class MBSimEnvironment;
34 class MultiDimNewtonMethod;
35 class ConstraintResiduum;
36 class ConstraintJacobian;
43 StateTable(
const std::string &name_,
char label_,
int number_) : name(name_), label(label_), number(number_) { }
66 fmatvec::Vec operator()(
const fmatvec::Vec &
z);
76 enum Solver { fixedpoint, GaussSeidel, direct, rootfinding, unknownSolver, directNonlinear };
136 void setTruncateSimulationFiles(
bool trunc) { truncateSimulationFiles=trunc; }
139 void init(
InitStage stage,
const InitConfigSet &config)
override;
155 void updateT()
override;
156 void updateh(
int i=0)
override;
157 void updateM()
override;
158 void updateLLM()
override;
159 void updatezd()
override;
175 virtual void updateJrla(
int j=0);
176 virtual void updaterdt();
177 void updatewb()
override;
178 void updateg()
override;
179 void updategd()
override;
180 void updateW(
int j=0)
override;
181 void updateV(
int j=0)
override;
182 virtual void updatebc();
183 virtual void updatebi();
184 virtual void updatela();
185 virtual void updateLa();
194 void setConstraintSolver(
Solver solver_) { contactSolver = solver_; }
195 void setImpactSolver(
Solver solver_) { impactSolver = solver_; }
197 const Solver& getConstraintSolver() {
return contactSolver; }
198 const Solver& getImpactSolver() {
return impactSolver; }
199 void setTermination(
bool term_) {
term = term_; }
200 void setMaximumNumberOfIterations(
int iter) {
maxIter = iter; }
201 void setHighNumberOfIterations(
int iter) { highIter = iter; }
202 void setNumericalJacobian(
bool numJac_) {
numJac = numJac_; }
203 void setMaximumDampingSteps(
int maxDSteps) { maxDampingSteps = maxDSteps; }
204 void setLevenbergMarquardtParamater(
double lmParm_) {
lmParm = lmParm_; }
206 void setUseOldla(
bool flag) {
useOldla = flag; }
207 void setDecreaseLevels(
const fmatvec::VecInt &decreaseLevels_) {
decreaseLevels = decreaseLevels_; }
208 void setCheckTermLevels(
const fmatvec::VecInt &checkTermLevels_) {
checkTermLevels = checkTermLevels_; }
209 void setCheckGSize(
bool checkGSize_) {
checkGSize = checkGSize_; }
212 double& getTime() {
return t; }
213 const double& getTime()
const {
return t; }
214 void setTime(
double t_) {
t = t_; }
216 double getStepSize()
const {
return dt; }
217 void setStepSize(
double dt_) {
dt = dt_; }
219 int getzSize()
const {
return zSize; }
221 fmatvec::Vec& getState() {
return z; }
222 const fmatvec::Vec& getState()
const {
return z; }
223 void setState(
const fmatvec::Vec &z_) {
z = z_; }
225 void setzd(
const fmatvec::Vec &zd_) {
zd = zd_; }
227 const fmatvec::SqrMat& getG(
bool check=
true)
const { assert((not check) or (not updG));
return G; }
228 const fmatvec::SparseMat& getGs(
bool check=
true)
const { assert((not check) or (not updG));
return Gs; }
229 const fmatvec::Vec& getbc(
bool check=
true)
const { assert((not check) or (not updbc));
return bc; }
230 const fmatvec::Vec& getbi(
bool check=
true)
const { assert((not check) or (not updbi));
return bi; }
231 const fmatvec::SqrMat& getJprox()
const {
return Jprox; }
232 fmatvec::SqrMat& getG(
bool check=
true) { assert((not check) or (not updG));
return G; }
233 fmatvec::SparseMat& getGs(
bool check=
true) { assert((not check) or (not updG));
return Gs; }
234 fmatvec::Vec& getbc(
bool check=
true) { assert((not check) or (not updbc));
return bc; }
235 fmatvec::Vec& getbi(
bool check=
true) { assert((not check) or (not updbi));
return bi; }
236 fmatvec::SqrMat& getJprox() {
return Jprox; }
237 const fmatvec::Vec& getr(
int j=0,
bool check=
true)
const { assert((not check) or (not updr[j]));
return r[j]; }
238 fmatvec::Vec& getr(
int j=0,
bool check=
true) { assert((not check) or (not updr[j]));
return r[j]; }
241 const fmatvec::Mat& getJrla(
int j=0,
bool check=
true)
const { assert((not check) or (not updJrla[j]));
return Jrla[j]; }
242 fmatvec::Mat& getJrla(
int j=0,
bool check=
true) { assert((not check) or (not updJrla[j]));
return Jrla[j]; }
244 const fmatvec::Vec& evaldq() {
if(upddq) updatedq();
return dq; }
245 const fmatvec::Vec& evaldu() {
if(upddu) updatedu();
return du; }
246 const fmatvec::Vec& evaldx() {
if(upddx) updatedx();
return dx; }
247 const fmatvec::Vec& evalzd();
248 const fmatvec::SqrMat& evalG() {
if(updG)
updateG();
return G; }
249 const fmatvec::SparseMat& evalGs() {
if(updG)
updateG();
return Gs; }
250 const fmatvec::Vec& evalbc() {
if(updbc) updatebc();
return bc; }
251 const fmatvec::Vec& evalbi() {
if(updbi) updatebi();
return bi; }
252 const fmatvec::Vec& evalsv();
253 const fmatvec::Vec& evalz0();
254 const fmatvec::Vec& evalla() {
if(updla) updatela();
return la; }
255 const fmatvec::Vec& evalLa() {
if(updLa) updateLa();
return La; }
257 fmatvec::Vec& getzParent() {
return zParent; }
258 fmatvec::Vec& getzdParent() {
return zdParent; }
259 fmatvec::Vec& getlaParent() {
return laParent; }
260 fmatvec::Vec& getLaParent() {
return LaParent; }
264 fmatvec::Mat& getWParent(
int i=0) {
return WParent[i]; }
265 fmatvec::Mat& getVParent(
int i=0) {
return VParent[i]; }
269 fmatvec::Vec& getgParent() {
return gParent; }
271 fmatvec::Vec& getgdParent() {
return gdParent; }
272 fmatvec::Vec& getresParent() {
return resParent; }
275 void resizezParent(
int nz) {
zParent.resize(nz); }
276 void resizezdParent(
int nz) {
zdParent.resize(nz); }
280 int getMaxIter() {
return maxIter;}
281 int getHighIter() {
return highIter;}
282 int getIterC() {
return iterc;}
283 int getIterI() {
return iteri;}
328 int solveImpactsNonlinearEquations();
347 virtual const fmatvec::Vec&
shift();
443 #ifdef HAVE_ANSICSIGNAL
444 using SigHandle = void (*)(int);
446 SigHandle oldSigTerm;
456 void checkExitRequest();
459 void setPartialEventDrivenSolver(
bool peds_) {
peds = peds_; }
466 void writez(std::string fileName,
bool formatH5=
true);
479 void readz0(std::string fileName);
481 void initializeUsingXML(xercesc::DOMElement *element)
override;
501 double getDynamicSystemSolverTolerance() {
return tolDSS; }
515 void setAlwaysConsiderContact(
bool alwaysConsiderContact_) { alwaysConsiderContact = alwaysConsiderContact_; }
517 void setInverseKinetics(
bool inverseKinetics_) { inverseKinetics = inverseKinetics_; }
518 bool getInverseKinetics()
const {
return inverseKinetics; }
520 void setInitialProjection(
bool initialProjection_) { initialProjection = initialProjection_; }
521 bool getInitialProjection()
const {
return initialProjection; }
523 void setDetermineEquilibriumState(
bool determineEquilibriumState_) { determineEquilibriumState = determineEquilibriumState_; }
524 bool getDetermineEquilibriumState()
const {
return determineEquilibriumState; }
526 void setUseConstraintSolverForSmoothMotion(
bool useConstraintSolverForSmoothMotion_) { useConstraintSolverForSmoothMotion = useConstraintSolverForSmoothMotion_; }
527 bool getUseConstraintSolverForSmoothMotion()
const {
return useConstraintSolverForSmoothMotion; }
529 void setUseConstraintSolverForPlot(
bool useConstraintSolverForPlot_) { useConstraintSolverForPlot = useConstraintSolverForPlot_; }
530 bool getUseConstraintSolverForPlot()
const {
return useConstraintSolverForPlot; }
532 fmatvec::Mat dhdq(
int lb=0,
int ub=0);
533 fmatvec::Mat dhdu(
int lb=0,
int ub=0);
537 void setRootID(
int ID) {rootID = ID;}
538 int getRootID()
const {
return rootID;}
540 void resetUpToDate()
override;
542 bool getUpdateT() {
return updT; }
543 bool getUpdateM() {
return updM; }
544 bool getUpdateLLM() {
return updLLM; }
545 bool getUpdateh(
int j) {
return updh[j]; }
546 bool getUpdater(
int j) {
return updr[j]; }
547 bool getUpdateJrla(
int j) {
return updJrla[j]; }
548 bool getUpdaterdt() {
return updrdt; }
549 bool getUpdateW(
int j) {
return updW[j]; }
550 bool getUpdateV(
int j) {
return updV[j]; }
551 bool getUpdatewb() {
return updwb; }
552 bool getUpdateg() {
return updg; }
553 bool getUpdategd() {
return updgd; }
554 bool getUpdatela() {
return updla; }
555 bool getUpdateLa() {
return updLa; }
556 bool getUpdatezd() {
return updzd; }
557 bool getUpdatedq() {
return upddq; }
558 bool getUpdatedu() {
return upddu; }
559 bool getUpdatedx() {
return upddx; }
560 void setUpdatela(
bool updla_) { updla = updla_; }
561 void setUpdateLa(
bool updLa_) { updLa = updLa_; }
562 void setUpdateG(
bool updG_) { updG = updG_; }
563 void setUpdatebi(
bool updbi_) { updbi = updbi_; }
564 void setUpdatebc(
bool updbc_) { updbc = updbc_; }
565 void setUpdatezd(
bool updzd_) { updzd = updzd_; }
566 void setUpdateW(
bool updW_,
int i=0) { updW[i] = updW_; }
605 void updatedq()
override;
606 void updatedu()
override;
607 void updatedx()
override;
609 void updateStopVector()
override;
611 void updateInternalState();
613 void plot()
override;
628 std::vector<StateTable>& getStateTable() {
return tabz; }
630 void setCompressionLevel(
int level) { compressionLevel=level; }
631 void setChunkSize(
int size) { chunkSize=size; }
632 void setCacheSize(
int size) { cacheSize=size; }
710 fmatvec::Vec curisParent, nextisParent;
732 fmatvec::Vec dxParent, dqParent, duParent;
744 fmatvec::Mat JrlaParent[2];
770 fmatvec::SparseMat
Gs;
795 int maxIter, highIter, maxDampingSteps, iterc, iteri;
870 fmatvec::Vec laInverseKineticsParent;
871 fmatvec::Mat bInverseKineticsParent;
876 fmatvec::Mat WInverseKineticsParent;
878 bool alwaysConsiderContact;
879 bool inverseKinetics;
880 bool initialProjection;
881 bool determineEquilibriumState;
882 bool useConstraintSolverForSmoothMotion;
883 bool useConstraintSolverForPlot;
885 fmatvec::Vec corrParent;
889 double gTol, gdTol, gddTol, laTol, LaTol;
891 bool updT, updh[2], updr[2], updJrla[2], updrdt, updM, updLLM, updW[2], updV[2], updwb, updg, updgd, updG, updbc, updbi, updsv, updzd, updla, updLa, upddq, upddu, upddx;
893 bool useSmoothSolver;
895 std::vector<StateTable> tabz;
897 int compressionLevel { H5::File::getDefaultCompression() };
898 int chunkSize { H5::File::getDefaultChunkSize() };
899 int cacheSize { H5::File::getDefaultCacheSize() };
931 void addToGraph(
Graph* graph, fmatvec::SqrMat &A,
int i, std::vector<Element*> &objList);
933 bool truncateSimulationFiles;
940 std::vector<DynamicSystem*> dynamicsystemPreReorganize;
944 std::vector<std::unique_ptr<Environment>> environments;
947 bool firstPlot {
true };
949 std::unique_ptr<MultiDimNewtonMethod> nonlinearConstraintNewtonSolver;
950 std::unique_ptr<ConstraintResiduum> constraintResiduum;
951 std::unique_ptr<ConstraintJacobian> constraintJacobian;
957 auto &reqType=
typeid(Env);
958 for(
auto &e : environments) {
960 if(reqType==
typeid(e_))
961 return static_cast<Env*>(e.get());
964 addEnvironment(newEnv);
int solveConstraintsNonlinearEquations()
solution of contact equations with direct nonlinear newton solver using minimum of least squares in e...
Definition: dynamic_system_solver.cc:964
bool useOldla
flag if contac force parameter of last time step should be used
Definition: dynamic_system_solver.h:820
Definition: dynamic_system_solver.h:38
void plot() override
plots time dependent data
Definition: dynamic_system_solver.cc:1732
int solveImpactsGaussSeidel() override
solve impact equations with Gauss-Seidel scheme on velocity level
Definition: dynamic_system_solver.cc:574
int solveConstraintsLinearEquations()
solution of contact equations with direct linear solver using minimum of least squares ...
Definition: dynamic_system_solver.cc:945
fmatvec::Vec gParent
relative distances
Definition: dynamic_system_solver.h:715
int zSize
size of state vector
Definition: dynamic_system_solver.h:648
double t
time
Definition: dynamic_system_solver.h:638
bool checkGSize
boolean if force action matrix should be resized in each step
Definition: dynamic_system_solver.h:840
int solveImpactsLinearEquations()
solution of contact equations with Cholesky decomposition on velocity level
Definition: dynamic_system_solver.cc:974
fmatvec::Vec rParent[2]
nonsmooth right hand side
Definition: dynamic_system_solver.h:742
int solveConstraintsGaussSeidel() override
solve contact equations with Gauss-Seidel scheme
Definition: dynamic_system_solver.cc:554
void initLa()
load contact impulses for use as starting value
Definition: dynamic_system_solver.cc:1251
bool term
boolean to check for termination of contact equations solution
Definition: dynamic_system_solver.h:790
void readz0(std::string fileName)
reads state from a file
Definition: dynamic_system_solver.cc:1394
Env * getEnvironment()
Definition: dynamic_system_solver.h:955
bool dropContactInfo
flag if contact matrices for debugging should be dropped in no-convergence case
Definition: dynamic_system_solver.h:815
int solveConstraintsFixpointSingle() override
solve contact equations with single step fixed point scheme
Definition: dynamic_system_solver.cc:494
double tolProj
Tolerance for projection of generalized position.
Definition: dynamic_system_solver.h:855
solver interface for modelling and simulation of dynamic systems
Definition: dynamic_system_solver.h:61
void initla()
load contact forces for use as starting value
Definition: dynamic_system_solver.cc:1241
virtual void updateVRef(fmatvec::Mat &VParent, int j=0)
references to condensed contact force direction matrix of dynamic system parent
Definition: dynamic_system.cc:857
fmatvec::SparseMat Gs
sparse mass action matrix
Definition: dynamic_system_solver.h:770
fmatvec::VecInt checkTermLevels
TODO.
Definition: dynamic_system_solver.h:835
DynamicSystemSolver(const std::string &name="")
constructor
Definition: dynamic_system_solver.cc:87
Solver smoothSolver
solver for contact equations and impact equations
Definition: dynamic_system_solver.h:805
void updategRef(fmatvec::Vec &ref) override
references to relative distances of dynamic system parent
Definition: dynamic_system_solver.h:572
fmatvec::Vec bc
TODO.
Definition: dynamic_system_solver.h:785
bool stopIfNoConvergence
flag if the contact equations should be stopped if there is no convergence
Definition: dynamic_system_solver.h:810
virtual const fmatvec::Vec & shift()
update for event driven integrator for event
Definition: dynamic_system_solver.cc:1559
void updateVRef(fmatvec::Mat &ref, int i=0) override
references to condensed contact force direction matrix of dynamic system parent
Definition: dynamic_system_solver.h:598
fmatvec::Mat TParent
matrix of linear relation between differentiated positions and velocities
Definition: dynamic_system_solver.h:673
fmatvec::Vec sParent
TODO.
Definition: dynamic_system_solver.h:703
fmatvec::VecInt LinkStatusRegParent
status vector of single valued links
Definition: dynamic_system_solver.h:765
void setLocalSolverTolerance(double tol)
set tolerance for local none-linear solver (solvers on element level), like the Newton-Solver in Join...
Definition: dynamic_system_solver.h:493
Definition: environment.h:37
fmatvec::Vec zd
derivative of state vector
Definition: dynamic_system_solver.h:658
void getLinkStatusReg(fmatvec::VecInt &LinkStatusRegExt)
Definition: dynamic_system_solver.cc:1098
void updateWRef(fmatvec::Mat &ref, int i=0) override
references to contact force direction matrix of dynamic system parent
Definition: dynamic_system_solver.h:591
fmatvec::Vec gdParent
relative velocities
Definition: dynamic_system_solver.h:720
void projectGeneralizedVelocities(int mode)
drift projection for positions
Definition: dynamic_system_solver.cc:1196
fmatvec::VecInt LinkStatusParent
status vector of set valued links with piecewise link equation (which piece is valid) ...
Definition: dynamic_system_solver.h:759
virtual void updatewbRef(fmatvec::Vec &wbParent)
references to TODO of dynamic system parent
Definition: dynamic_system.cc:829
group ingredients do not depend on each other
Definition: group.h:35
void checkImpactsForTermination() override
validate force laws concerning given tolerances on velocity level
Definition: dynamic_system_solver.cc:737
std::string getSolverInfo()
Definition: dynamic_system_solver.cc:1295
fmatvec::Vec z
state vector
Definition: dynamic_system_solver.h:653
basic class of MBSim mainly for plotting
Definition: element.h:56
static void sigInterruptHandler(int)
handler for user interrupt signal
Definition: dynamic_system_solver.cc:1347
double lmParm
Levenberg-Marquard parameter.
Definition: dynamic_system_solver.h:800
int solveImpactsFixpointSingle() override
solve impact equations with single step fixed point scheme on velocity level
Definition: dynamic_system_solver.cc:524
void addElement(Element *element_)
Definition: dynamic_system_solver.cc:1256
fmatvec::Vec rFactorParent
relaxation parameters for contact equations
Definition: dynamic_system_solver.h:698
void checkConstraintsForTermination() override
validate force laws concerning given tolerances
Definition: dynamic_system_solver.cc:726
virtual void updateWRef(fmatvec::Mat &WParent, int j=0)
references to contact force direction matrix of dynamic system parent
Definition: dynamic_system.cc:836
fmatvec::VecInt decreaseLevels
decreasing relaxation factors is done in levels containing the number of contact iterations as condit...
Definition: dynamic_system_solver.h:830
virtual void updatelaInverseKinetics()
update inverse kinetics constraint forces
Definition: dynamic_system_solver.cc:1653
double tolLocalSolver
Tolerance for local none-linear solvers (solvers on element level)
Definition: dynamic_system_solver.h:860
void setStopIfNoConvergence(bool flag, bool dropInfo=false)
Definition: dynamic_system_solver.h:427
Definition: dynamic_system_solver.h:63
Definition: environment.h:59
virtual void updater(int j=0)
update smooth link force law
Definition: dynamic_system_solver.cc:851
void dropContactMatrices()
Definition: dynamic_system_solver.cc:1312
void updatezdRef(fmatvec::Vec &ext)
references to differentiated external state
Definition: dynamic_system_solver.cc:1414
void initialize()
Initialize the system.
Definition: dynamic_system_solver.cc:106
virtual void updateG()
updates mass action matrix
Definition: dynamic_system_solver.cc:983
~DynamicSystemSolver() override
destructor
Definition: dynamic_system_solver.cc:98
bool numJac
flag if Jacobian for Newton scheme should be calculated numerically
Definition: dynamic_system_solver.h:825
void setDynamicSystemSolverTolerance(double tol)
set tolerance for global none-linear solver (solvers on DynamicSystemSolver level), like the Newton-Solver in directNonlinear
Definition: dynamic_system_solver.h:500
int(DynamicSystemSolver::* solveImpacts_)()
function pointer for election of prox-solver for impact equations on velocity level ...
Definition: dynamic_system_solver.h:304
fmatvec::Mat WParent[2]
contact force directions
Definition: dynamic_system_solver.h:678
void plot() override
plots time dependent data
Definition: dynamic_system.cc:344
class for tree-structured mechanical systems with recursive and flat memory mechanism ...
Definition: graph.h:36
InitStage
The stages of the initialization.
Definition: element.h:62
void setProjectionTolerance(double tol)
set tolerance for projection of generalized position
Definition: dynamic_system_solver.h:487
int(DynamicSystemSolver::* solveConstraints_)()
Definition: dynamic_system_solver.h:297
Element * getElement(const std::string &name)
Definition: dynamic_system_solver.cc:1268
bool positionDriftCompensationNeeded(double gmax)
check if drift compensation on position level is needed
Definition: dynamic_system_solver.cc:1106
fmatvec::VecInt jsvParent
boolean evaluation of stopvector
Definition: dynamic_system_solver.h:754
void savela()
save contact forces for use as starting value in next time step
Definition: dynamic_system_solver.cc:1236
double tolDSS
Tolerance for global none-linear solvers (solvers on DynamicSystemSolver level)
Definition: dynamic_system_solver.h:865
Definition: contact_kinematics.h:32
void projectGeneralizedPositions(int mode, bool fullUpdate=false)
drift projection for positions
Definition: dynamic_system_solver.cc:1132
fmatvec::SymMat LLMParent
Cholesky decomposition of mass matrix.
Definition: dynamic_system_solver.h:668
std::string name
name of element
Definition: element.h:260
static std::atomic< bool > exitRequest
boolean signal evaluation for end integration set by user
Definition: dynamic_system_solver.h:915
int limitGSize
TODO.
Definition: dynamic_system_solver.h:845
fmatvec::SymMat MParent
mass matrix
Definition: dynamic_system_solver.h:663
bool peds
TODO, flag for occuring impact and sticking in event driven solver.
Definition: dynamic_system_solver.h:850
fmatvec::Vec hParent[2]
smooth, smooth with respect to objects, smooth with respect to links right hand side ...
Definition: dynamic_system_solver.h:737
void writeStateTable(std::string fileName)
writes state table to a file
Definition: dynamic_system_solver.cc:1383
void constructor()
set plot feature default values
Definition: dynamic_system_solver.cc:1428
fmatvec::SqrMat G
mass action matrix
Definition: dynamic_system_solver.h:780
double dt
step size
Definition: dynamic_system_solver.h:643
void saveLa()
save contact impulses for use as starting value in next time step
Definition: dynamic_system_solver.cc:1246
bool integratorExitRequest
boolean signal evaluation for end integration set by program
Definition: dynamic_system_solver.h:910
fmatvec::Vec wbParent
TODO.
Definition: dynamic_system_solver.h:688
void addToGraph(Graph *graph, fmatvec::SqrMat &A, int i, std::vector< Element * > &objList)
adds list of objects to tree
Definition: dynamic_system_solver.cc:1546
virtual void updategRef(fmatvec::Vec &gParent)
references to relative distances of dynamic system parent
Definition: dynamic_system.cc:794
void updatewbRef(fmatvec::Vec &ref) override
references to TODO of dynamic system parent
Definition: dynamic_system_solver.h:584
fmatvec::Vec la
contact force parameters
Definition: dynamic_system.h:871
int maxIter
maximum number of contact iterations, high number of contact iterations for warnings, maximum number of damping steps for Newton scheme
Definition: dynamic_system_solver.h:795
void getLinkStatus(fmatvec::VecInt &LinkStatusExt)
Definition: dynamic_system_solver.cc:1090
Solver
solver for contact equations
Definition: dynamic_system_solver.h:76
MBSimEnvironment * getMBSimEnvironment()
Definition: dynamic_system_solver.cc:1774
fmatvec::Vec zParent
state
Definition: dynamic_system_solver.h:725
fmatvec::Vec laParent
contact force parameters
Definition: dynamic_system_solver.h:693
fmatvec::Vec resParent
residuum of contact equations
Definition: dynamic_system_solver.h:708
bool velocityDriftCompensationNeeded(double gdmax)
check if drift compensation on velocity level is needed
Definition: dynamic_system_solver.cc:1119
fmatvec::Vec svParent
stopvector (rootfunctions for event driven integration
Definition: dynamic_system_solver.h:749
fmatvec::SqrMat Jprox
JACOBIAN of contact equations for Newton scheme.
Definition: dynamic_system_solver.h:775
fmatvec::Mat VParent[2]
condensed contact force directions
Definition: dynamic_system_solver.h:683
void updatezRef(fmatvec::Vec &ext)
references to external state
Definition: dynamic_system_solver.cc:1402
void writez(std::string fileName, bool formatH5=true)
writes state to a file
Definition: dynamic_system_solver.cc:1361
fmatvec::Mat Jrla[2]
Jacobian dr/dla.
Definition: dynamic_system.h:861
void init(InitStage stage, const InitConfigSet &config) override
plots time series header
Definition: dynamic_system_solver.cc:122
int solveConstraintsRootFinding() override
solve contact equations with Newton scheme
Definition: dynamic_system_solver.cc:594
void decreaserFactors()
decrease relaxation factors if mass action matrix is not diagonal dominant
Definition: dynamic_system_solver.cc:1084
void computeInitialCondition()
compute initial condition for links for event driven integrator
Definition: dynamic_system_solver.cc:902
bool READZ0
is a state read from a file
Definition: dynamic_system_solver.h:916
int solveImpactsRootFinding() override
solve impact equations with Newton scheme on velocity level
Definition: dynamic_system_solver.cc:661
void updategdRef(fmatvec::Vec &ref) override
references to relative velocities of dynamic system parent
Definition: dynamic_system_solver.h:578
virtual void updategdRef(fmatvec::Vec &gdParent)
references to relative velocities of dynamic system parent
Definition: dynamic_system.cc:801
fmatvec::Vec zdParent
differentiated state
Definition: dynamic_system_solver.h:730
Definition: dynamic_system_solver.h:438