MBSim

Project Page
Public Member Functions | Static Public Member Functions | Public Attributes | Protected Member Functions | Protected Attributes | Private Member Functions | Private Attributes | Static Private Attributes
MBSim::DynamicSystemSolver Class Reference

solver interface for modelling and simulation of dynamic systems More...

#include <dynamic_system_solver.h>

Inheritance diagram for MBSim::DynamicSystemSolver:
MBSim::Group MBSim::DynamicSystem MBSim::Element

List of all members.

Public Member Functions

 DynamicSystemSolver ()
 constructor
 DynamicSystemSolver (const std::string &projectName)
 constructor
virtual ~DynamicSystemSolver ()
 destructor
void initialize ()
 Initialize the system.
void setTruncateSimulationFiles (bool trunc)
void init (InitStage stage)
 plots time series header
virtual int solveConstraintsFixpointSingle ()
 solve contact equations with single step fixed point scheme on acceleration level
virtual int solveImpactsFixpointSingle (double dt=0)
 solve contact equations with single step fixed point scheme on velocity level
virtual int solveConstraintsGaussSeidel ()
 solve contact equations with Gauss-Seidel scheme on acceleration level
virtual int solveImpactsGaussSeidel (double dt=0)
 solve contact equations with Gauss-Seidel scheme on velocity level
virtual int solveConstraintsRootFinding ()
 solve contact equations with Newton scheme on acceleration level
virtual int solveImpactsRootFinding (double dt=0)
 solve contact equations with Newton scheme on velocity level
virtual void checkConstraintsForTermination ()
 validate force laws concerning given tolerances on acceleration level
virtual void checkImpactsForTermination (double dt=0)
 validate force laws concerning given tolerances on velocity level
virtual void updateh (double t, int i=0)
virtual void updateh0Fromh1 (double t)
virtual void updateW0FromW1 (double t)
virtual void updateV0FromV1 (double t)
virtual void updateM (double t, int i=0)
virtual void updateStateDependentVariables (double t)
virtual void updater (double t, int j=0)
 update smooth link force law
virtual void updatewb (double t, int j=0)
virtual void updateW (double t, int j=0)
virtual void updateV (double t, int j=0)
virtual std::string getType () const
 DEPRECATED.
virtual void plot (const fmatvec::Vec &z, double t, double dt=1)
virtual void plot2 (const fmatvec::Vec &z, double t, double dt=1)
virtual void closePlot ()
 closes plot file
virtual int solveConstraints ()
 solves prox-functions on acceleration level using sparsity structure but not decoupled
virtual int solveImpacts (double dt=0)
 solves prox-functions on velocity level using sparsity structure but not decoupled
void setConstraintSolver (Solver solver_)
void setImpactSolver (Solver solver_)
const Solver & getImpactSolver ()
void setTermination (bool term_)
void setStrategy (Strategy strategy_)
void setMaxIter (int iter)
void setHighIter (int iter)
void setNumJacProj (bool numJac_)
void setMaxDampingSteps (int maxDSteps)
void setLevenbergMarquardtParam (double lmParm_)
void setLinAlg (LinAlg linAlg_)
void setUseOldla (bool flag)
void setDecreaseLevels (const fmatvec::Vector< int > &decreaseLevels_)
void setCheckTermLevels (const fmatvec::Vector< int > &checkTermLevels_)
void setCheckGSize (bool checkGSize_)
void setLimitGSize (int limitGSize_)
const fmatvec::Matrix
< fmatvec::Sparse, double > & 
getGs () const
fmatvec::Matrix
< fmatvec::Sparse, double > & 
getGs ()
const fmatvec::SqrMat & getG () const
fmatvec::SqrMat & getG ()
const fmatvec::Vec & getb () const
fmatvec::Vec & getb ()
const fmatvec::SqrMat & getJprox () const
fmatvec::SqrMat & getJprox ()
const fmatvec::Mat & getWParent (int i=0) const
const fmatvec::Mat & getVParent (int i=0) const
const fmatvec::Vec & getlaParent () const
const fmatvec::Vec & getgdParent () const
const fmatvec::Vec & getresParent () const
const fmatvec::Vec & getrFactorParent () const
DynamicSystemSolver * getDynamicSystemSolver ()
bool getIntegratorExitRequest ()
int getMaxIter ()
void computeInitialCondition ()
 compute initial condition for links for event driven integrator
fmatvec::Vec deltau (const fmatvec::Vec &zParent, double t, double dt)
fmatvec::Vec deltaq (const fmatvec::Vec &zParent, double t, double dt)
fmatvec::Vec deltax (const fmatvec::Vec &zParent, double t, double dt)
 return x-state difference for current time
void initz (fmatvec::Vec &z0)
 initialises state variables
int solveConstraintsLinearEquations ()
int solveImpactsLinearEquations (double dt=0)
void updateG (double t, int i=0)
 updates mass action matrix
void decreaserFactors ()
 decrease relaxation factors if mass action matrix is not diagonal dominant
void update (const fmatvec::Vec &z, double t, int options=0)
 update of dynamic system for time-stepping integrator
virtual void shift (fmatvec::Vec &z, const fmatvec::Vector< int > &jsv, double t)
 update for event driven integrator for event
virtual void zdot (const fmatvec::Vec &z, fmatvec::Vec &zd, double t)
 update for event driven integrator during smooth phase
virtual fmatvec::Vec zdot (const fmatvec::Vec &zParent, double t)
 standard invocation of smooth update for event driven integration
virtual void getsv (const fmatvec::Vec &z, fmatvec::Vec &svExt, double t)
 evaluation of stop vector
void getLinkStatus (fmatvec::Vector< int > &LinkStatusExt, double t)
 brief collect status of all set-valued links
void getLinkStatusReg (fmatvec::Vector< int > &LinkStatusRegExt, double t)
 brief collect status of all single-valued links
void projectGeneralizedPositions (double t, int mode)
 drift projection for positions
void projectGeneralizedVelocities (double t, int mode)
 drift projection for positions
void savela (double dt=1.0)
 save contact force parameter for use as starting value in next time step
void initla (double dt=1.0)
 load contact force parameter for use as starting value
double computeKineticEnergy ()
 compute kinetic energy of entire dynamic system
double computePotentialEnergy ()
 compute potential energy of entire dynamic system change? TODO
void addElement (Element *element_)
Element * getElement (const std::string &name)
std::string getSolverInfo ()
void setStopIfNoConvergence (bool flag, bool dropInfo=false)
void dropContactMatrices ()
 writes a file with relevant matrices for debugging
void setPartialEventDrivenSolver (bool peds_)
void writez (std::string fileName, bool formatH5=true)
 writes state to a file
void readz0 (std::string fileName)
 reads state from a file
virtual void initializeUsingXML (TiXmlElement *element)
void setReorganizeHierarchy (bool flag)
 decide, whether the model-hierarchy should be reorganized.
void setProjectionTolerance (double tol)
 set tolerance for projection of generalized position
void setInformationOutput (bool INFO_)
void updatezRef (const fmatvec::Vec &ext)
 references to external state
void setFlushEvery (unsigned int every)
 set the number of plot-routine-calls after which all hdf5-files will be flushed
void setAlwaysConsiderContact (bool alwaysConsiderContact_)
void setInverseKinetics (bool inverseKinetics_)
fmatvec::Mat dhdq (double t, int lb=0, int ub=0)
fmatvec::Mat dhdu (double t, int lb=0, int ub=0)
fmatvec::Mat dhdx (double t)
fmatvec::Vec dhdt (double t)
void setRootID (int ID)
int getRootID () const
- Public Member Functions inherited from MBSim::Group
 Group (const std::string &name)
 constructor
virtual ~Group ()
 destructor
virtual void updateJacobians (double t, int j=0)
virtual void facLLM (int i=0)
 compute Cholesky decomposition of mass matrix TODO necessary?
virtual void updatedu (double t, double dt)
virtual void updatezd (double t)
virtual void updateud (double t, int i=0)
- Public Member Functions inherited from MBSim::DynamicSystem
 DynamicSystem (const std::string &name)
 constructor
virtual ~DynamicSystem ()
 destructor
virtual void updateT (double t)
virtual void updateStateDerivativeDependentVariables (double t)
virtual void updatedq (double t, double dt)
virtual void updateqd (double t)
virtual void sethSize (int hSize_, int i=0)
virtual int gethSize (int i=0) const
virtual int getqSize () const
virtual int getuSize (int i=0) const
virtual void calcqSize ()
virtual void calcuSize (int j=0)
virtual int getuInd (int i=0)
virtual void setqInd (int qInd_)
virtual void setuInd (int uInd_, int i=0)
virtual void sethInd (int hInd_, int i=0)
virtual void setxInd (int xInd_)
virtual const fmatvec::Vec & getq () const
virtual fmatvec::Vec & getq ()
virtual const fmatvec::Vec & getu () const
virtual fmatvec::Vec & getu ()
virtual H5::Group * getPlotGroup ()
virtual PlotFeatureStatus getPlotFeature (PlotFeature fp)
virtual PlotFeatureStatus getPlotFeatureForChildren (PlotFeature fp)
std::string getPath (char pathDelim='.')
 Return the full path of the object.
virtual void updateg (double t)
virtual void updategd (double t)
virtual void updateStopVector (double t)
virtual void updateLinkStatus (double t)
virtual void updateLinkStatusReg (double t)
virtual void updategInverseKinetics (double t)
virtual void updategdInverseKinetics (double t)
virtual void updateWInverseKinetics (double t, int j=0)
virtual void updatehInverseKinetics (double t, int j=0)
virtual void updateJacobiansInverseKinetics (double t, int j=0)
virtual void updatebInverseKinetics (double t)
virtual void updatedx (double t, double dt)
virtual void updatexd (double t)
virtual void calcxSize ()
const fmatvec::Vec & getx () const
fmatvec::Vec & getx ()
int getxSize () const
void updatexRef (const fmatvec::Vec &ref)
void updatexdRef (const fmatvec::Vec &ref)
virtual void initz ()
virtual void setDynamicSystemSolver (DynamicSystemSolver *sys)
virtual void plot (double t, double dt)
 plots time dependent data
virtual void plotAtSpecialEvent (double t, double dt=1.)
 plots time dependent data at special events
virtual int jacobianConstraints ()
 compute JACOBIAN of contact equations on acceleration level
virtual int jacobianImpacts ()
 compute JACOBIAN of contact equations on velocity level
virtual Frame * getFrame (const std::string &name, bool check=true)
virtual Contour * getContour (const std::string &name, bool check=true)
void setPosition (const fmatvec::Vec &PrPF_)
void setOrientation (const fmatvec::SqrMat &APF_)
void setFrameOfReference (Frame *frame)
const fmatvec::Vec & getxd () const
fmatvec::Vec & getxd ()
const fmatvec::Vec & getx0 () const
fmatvec::Vec & getx0 ()
const fmatvec::Mat & getT () const
const fmatvec::SymMat & getM (int i=0) const
const fmatvec::SymMat & getLLM (int i=0) const
const fmatvec::Vec & geth (int j=0) const
const fmatvec::Vec & getf () const
fmatvec::Vec & getf ()
const fmatvec::Mat & getW (int i=0) const
fmatvec::Mat & getW (int i=0)
const fmatvec::Mat & getV (int i=0) const
fmatvec::Mat & getV (int i=0)
const fmatvec::Vec & getla () const
fmatvec::Vec & getla ()
const fmatvec::Vec & getg () const
fmatvec::Vec & getg ()
const fmatvec::Vec & getgd () const
fmatvec::Vec & getgd ()
const fmatvec::Vec & getrFactor () const
fmatvec::Vec & getrFactor ()
fmatvec::Vec & getsv ()
const fmatvec::Vec & getsv () const
fmatvec::Vector< int > & getjsv ()
const fmatvec::Vector< int > & getjsv () const
fmatvec::Vector< int > & getLinkStatus ()
fmatvec::Vector< int > & getLinkStatusReg ()
const fmatvec::Vector< int > & getLinkStatus () const
const fmatvec::Vector< int > & getLinkStatusReg () const
const fmatvec::Vec & getres () const
fmatvec::Vec & getres ()
void setx (const fmatvec::Vec &x_)
void setx0 (const fmatvec::Vec &x0_)
void setx0 (double x0_)
int getxInd ()
int getlaInd () const
int gethInd (int i=0)
void setlaInd (int ind)
void setgInd (int ind)
void setgdInd (int ind)
void setrFactorInd (int ind)
void setsvInd (int svInd_)
void setLinkStatusInd (int LinkStatusInd_)
void setLinkStatusRegInd (int LinkStatusRegInd_)
int getzSize () const
void setqSize (int qSize_)
void setuSize (int uSize_, int i=0)
void setxSize (int xSize_)
int getlaSize () const
int getgSize () const
int getgdSize () const
int getrFactorSize () const
int getsvSize () const
int getLinkStatusSize () const
int getLinkStatusRegSize () const
void updateqRef (const fmatvec::Vec &ref)
 references to positions of dynamic system parent
void updateqdRef (const fmatvec::Vec &ref)
 references to differentiated positions of dynamic system parent
void updateuRef (const fmatvec::Vec &ref)
 references to velocities of dynamic system parent
void updateuallRef (const fmatvec::Vec &ref)
 references to velocities of dynamic system parent
void updateudRef (const fmatvec::Vec &ref, int i=0)
 references to differentiated velocities of dynamic system parent
void updateudallRef (const fmatvec::Vec &ref, int i=0)
 references to velocities of dynamic system parent
void updatehRef (const fmatvec::Vec &hRef, int i=0)
 references to smooth right hand side of dynamic system parent
void updatefRef (const fmatvec::Vec &ref)
 references to order one right hand side of dynamic system parent
void updaterRef (const fmatvec::Vec &ref, int j=0)
 references to nonsmooth right hand side of dynamic system parent
void updateTRef (const fmatvec::Mat &ref)
 references to linear transformation matrix between differentiated positions and velocities of dynamic system parent
void updateMRef (const fmatvec::SymMat &ref, int i=0)
 references to mass matrix of dynamic system parent
void updateLLMRef (const fmatvec::SymMat &ref, int i=0)
 references to Cholesky decomposition of dynamic system parent
void updategRef (const fmatvec::Vec &ref)
 references to relative distances of dynamic system parent
void updategdRef (const fmatvec::Vec &ref)
 references to relative velocities of dynamic system parent
void updatelaRef (const fmatvec::Vec &ref)
 references to contact force parameters of dynamic system parent
void updatelaInverseKineticsRef (const fmatvec::Vec &ref)
void updatebInverseKineticsRef (const fmatvec::Mat &ref)
void updatewbRef (const fmatvec::Vec &ref)
 references to TODO of dynamic system parent
void updateWRef (const fmatvec::Mat &ref, int i=0)
 references to contact force direction matrix of dynamic system parent
void updateWnVRefObjects ()
void updateWInverseKineticsRef (const fmatvec::Mat &ref, int i=0)
 references to contact force direction matrix of dynamic system parent
void updateVRef (const fmatvec::Mat &ref, int i=0)
 references to condensed contact force direction matrix of dynamic system parent
void updatesvRef (const fmatvec::Vec &ref)
 references to stopvector (rootfunction for event driven integrator) of dynamic system parent
void updatejsvRef (const fmatvec::Vector< int > &ref)
 references to boolean evaluation of stopvector concerning roots of dynamic system parent
void updateLinkStatusRef (const fmatvec::Vector< int > &LinkStatusParent)
 references to status vector of set valued links with piecewise link equations (which piece is valid)
void updateLinkStatusRegRef (const fmatvec::Vector< int > &LinkStatusRegParent)
 references to status vector of single valued links
void updateresRef (const fmatvec::Vec &ref)
 references to residuum of contact equations of dynamic system parent
void updaterFactorRef (const fmatvec::Vec &ref)
 references to relaxation factors for contact equations of dynamic system parent
virtual void buildListOfObjects (std::vector< Object * > &obj, bool recursive=false)
 build flat list of objects
virtual void buildListOfLinks (std::vector< Link * > &lnk, bool recursive=false)
 build flat list of links
virtual void buildListOfSetValuedLinks (std::vector< Link * > &lnk, bool recursive=false)
 build flat list of all setvalued links
virtual void buildListOfFrames (std::vector< Frame * > &frm, bool recursive)
 build flat list of frames
virtual void buildListOfContours (std::vector< Contour * > &cnt, bool recursive)
 build flat list of contours
virtual void buildListOfExtraDynamic (std::vector< ExtraDynamic * > &ed, bool recursive=false)
 build flat list of extra dynamic
void buildListOfModels (std::vector< ModellingInterface * > &model, bool recursive=true)
 build flat list of models
void setUpInverseKinetics ()
 analyse constraints of dynamic systems for usage in inverse kinetics
void setUpLinks ()
 distribute links to set- and single valued container
bool gActiveChanged ()
bool gActiveChangedReg ()
void calcsvSize ()
 calculates size of stop vector
void calclaSize (int j)
 calculates size of contact force parameters
void calcLinkStatusSize ()
 calculates size of set-valued link status vector
void calcLinkStatusRegSize ()
 calculates size of single-valued link status vector
void calclaInverseKineticsSize ()
 calculates size of contact force parameters
void calcbInverseKineticsSize ()
 calculates size of contact force parameters
void calcgSize (int j)
 calculates size of relative distances
void calcgdSize (int j)
 calculates size of relative velocities
void calcrFactorSize (int j)
 calculates size of relaxation factors for contact equations
void setUpActiveLinks ()
 rearrange vector of active setvalued links
void checkActive (int i)
 check if set-valued contacts are active
void checkActiveReg (int i)
 check if single-valued contacts are active
void setgTol (double tol)
void setgdTol (double tol)
void setgddTol (double tol)
void setlaTol (double tol)
void setLaTol (double tol)
void setrMax (double rMax)
void addFrame (Frame *frame_, const fmatvec::Vec &RrRF, const fmatvec::SqrMat &ARF, const std::string &refFrameName)
void addFrame (Frame *frame_, const fmatvec::Vec &RrRF, const fmatvec::SqrMat &ARF, const Frame *refFrame=0)
void addFrame (const std::string &str, const fmatvec::Vec &RrRF, const fmatvec::SqrMat &ARF, const Frame *refFrame=0)
void addContour (Contour *contour, const fmatvec::Vec &RrRC, const fmatvec::SqrMat &ARC, const std::string &refFrameName)
void addContour (Contour *contour, const fmatvec::Vec &RrRC, const fmatvec::SqrMat &ARC, const Frame *refFrame=0)
void addContour (Contour *contour, const fmatvec::Vec &RrRC, const Frame *refFrame=0)
int frameIndex (const Frame *frame_) const
void addGroup (DynamicSystem *dynamicsystem)
DynamicSystem * getGroup (const std::string &name, bool check=true)
void addObject (Object *object)
Object * getObject (const std::string &name, bool check=true)
void addLink (Link *link)
void addInverseKineticsLink (Link *link)
Link * getLink (const std::string &name, bool check=true)
void addExtraDynamic (ExtraDynamic *ed_)
ExtraDynamic * getExtraDynamic (const std::string &name, bool check=true)
void addModel (ModellingInterface *modell)
ModellingInterface * getModel (const std::string &name, bool check=true)
Frame * getFrameI ()
 Return frame "I".
virtual Element * getByPathSearch (std::string path)
 a general element search by path
virtual void updatecorr (int j)
void updatecorrRef (const fmatvec::Vec &ref)
void calccorrSize (int j)
void checkRoot ()
- Public Member Functions inherited from MBSim::Element
 Element (const std::string &name)
 constructor
virtual ~Element ()
 destructor
virtual void initDataInterfaceBase (DynamicSystemSolver *parentds)
 TODO.
const std::string & getName () const
const std::string getShortName () const
void setName (const std::string &str)
virtual void createPlotGroup ()
 creates the plotGroup for H5-output
virtual void setPlotFeature (PlotFeature pf, PlotFeatureStatus value)
 Set a plot feature.
void setPlotFeatureForChildren (PlotFeature pf, PlotFeatureStatus value)
 Set a plot feature for the children of this object.
void setPlotFeatureRecursive (PlotFeature pf, PlotFeatureStatus value)
 Set a plot feature for this object and the children of this object.
template<class T >
T * getByPath (std::string path)
 a general element access
virtual Element * getParent ()
virtual const Element * getParent () const
virtual void setParent (Element *parent_)

Static Public Member Functions

static void sigInterruptHandler (int)
 handler for user interrupt signal
static void sigAbortHandler (int)
 handler for abort signals

Public Attributes

int(DynamicSystemSolver::* solveConstraints_ )()
int(DynamicSystemSolver::* solveImpacts_ )(double dt)
- Public Attributes inherited from MBSim::Group
fmatvec::Vec RrRD
fmatvec::SqrMat ARD

Protected Member Functions

void updatezdRef (const fmatvec::Vec &ext)
 references to differentiated external state
void updaterFactors ()
 update relaxation factors for contact equations
void computeConstraintForces (double t)
 compute inverse kinetics constraint forces

Protected Attributes

fmatvec::SymMat MParent [2]
 mass matrix
fmatvec::SymMat LLMParent [2]
 Cholesky decomposition of mass matrix.
fmatvec::Mat TParent
 matrix of linear relation between differentiated positions and velocities
fmatvec::Mat WParent [2]
 contact force directions
fmatvec::Mat VParent [2]
 condensed contact force directions
fmatvec::Vec wbParent
 TODO.
fmatvec::Vec laParent
 contact force parameters
fmatvec::Vec rFactorParent
 relaxation parameters for contact equations
fmatvec::Vec sParent
 TODO.
fmatvec::Vec resParent
 residuum of contact equations
fmatvec::Vec gParent
 relative distances
fmatvec::Vec gdParent
 relative velocities
fmatvec::Vec zdParent
 differentiated state
fmatvec::Vec udParent1
fmatvec::Vec hParent [2]
 smooth, smooth with respect to objects, smooth with respect to links right hand side
fmatvec::Vec rParent [2]
 nonsmooth right hand side
fmatvec::Vec fParent
 right hand side of order one parameters
fmatvec::Vec svParent
 stopvector (rootfunctions for event driven integration
fmatvec::Vector< int > jsvParent
 boolean evaluation of stopvector
fmatvec::Vector< int > LinkStatusParent
 status vector of set valued links with piecewise link equation (which piece is valid)
fmatvec::Vector< int > LinkStatusRegParent
 status vector of single valued links
fmatvec::Matrix
< fmatvec::Sparse, double > 
Gs
 sparse mass action matrix
fmatvec::SqrMat Jprox
 JACOBIAN of contact equations for Newton scheme.
fmatvec::SqrMat G
 mass action matrix
fmatvec::Vec b
 TODO.
bool term
 boolean to check for termination of contact equations solution
int maxIter
 maximum number of contact iterations, high number of contact iterations for warnings, maximum number of damping steps for Newton scheme
int highIter
int maxDampingSteps
double lmParm
 Levenberg-Marquard parameter.
Solver contactSolver
 solver for contact equations on acceleration and velocity level
Solver impactSolver
Strategy strategy
 relaxarion strategy for solution of fixed-point scheme
LinAlg linAlg
 linear system solver used for Newton scheme in contact equations
bool stopIfNoConvergence
 flag if the contact equations should be stopped if there is no convergence
bool dropContactInfo
 flag if contact matrices for debugging should be dropped in no-convergence case
bool useOldla
 flag if contac force parameter of last time step should be used
bool numJac
 flag if Jacobian for Newton scheme should be calculated numerically
fmatvec::Vector< int > decreaseLevels
 decreasing relaxation factors is done in levels containing the number of contact iterations as condition
fmatvec::Vector< int > checkTermLevels
 TODO.
bool checkGSize
 boolean if force action matrix should be resized in each step
int limitGSize
 TODO.
int warnLevel
 level for warning output (0-2)
bool peds
 TODO, flag for occuring impact and sticking in event driven solver.
unsigned int driftCount
 TODO, additional stop in event driven solver for drift correction.
unsigned int flushEvery
 flushes all hdf5-files every x-times the plot-routine is called TODO
unsigned int flushCount
 counts plot-calls until files to be flushed TODO
bool reorganizeHierarchy
 Flag for reorganisation of hierarchy.
double tolProj
 Tolerance for projection of generalized position.
fmatvec::Vec laInverseKineticsParent
fmatvec::Mat bInverseKineticsParent
fmatvec::Mat WInverseKineticsParent [2]
bool alwaysConsiderContact
bool inverseKinetics
fmatvec::Vec corrParent
int rootID

Private Member Functions

void constructor ()
 set plot feature default values
void addToGraph (Graph *graph, fmatvec::SqrMat &A, int i, std::vector< Object * > &objList)
 adds list of objects to tree

Private Attributes

bool integratorExitRequest
 boolean signal evaluation for end integration set by program
bool INFO
 information on standard output
bool READZ0
 is a state read from a file
bool truncateSimulationFiles

Static Private Attributes

static bool exitRequest
 boolean signal evaluation for end integration set by user

Detailed Description

solver interface for modelling and simulation of dynamic systems

Author:
Martin Foerg
Date:
2009-03-31 some comments (Thorsten Schindler)
2009-07-16 splitted link / object right hand side (Thorsten Schindler)
2009-07-27 implicit integration (Thorsten Schindler)
2009-07-28 splitted interfaces (Thorsten Schindler)
2009-08-07 preintegration (Thorsten Schindler)
2009-08-21 reorganize hierarchy (Thorsten Schindler)
2009-12-14 revised inverse kinetics (Martin Foerg)
2010-07-06 modifications for timestepper ssc - e.g LinkStatus (Robert Huber)
2012-05-08 modifications for AutoTimeSteppingSSCIntegrator (Jan Clauberg)
2012-05-08 dhdq and dhdu with lower and upper bound (Jan Clauberg)
Todo:

projectGeneralizedPositions seems to be buggy with at least TimeSteppingIntegrator (see SliderCrank)

RootFinding seems to be buggy (see EdgeMill)


Constructor & Destructor Documentation

MBSim::DynamicSystemSolver::DynamicSystemSolver ( const std::string &  projectName)

constructor

Parameters:
nameof dynamic system

Member Function Documentation

void MBSim::DynamicSystemSolver::addElement ( Element *  element_)
Parameters:
elementto add
Todo:
necessary? TODO
void MBSim::DynamicSystemSolver::addToGraph ( Graph *  graph,
fmatvec::SqrMat &  A,
int  i,
std::vector< Object * > &  objList 
)
private

adds list of objects to tree

Parameters:
treewhere to add objects
currentnode in the tree
matrixof dependencies
currententry of matrix of dependencies
listof objects
void MBSim::DynamicSystemSolver::computeConstraintForces ( double  t)
protected

compute inverse kinetics constraint forces

Parameters:
currenttime
fmatvec::Vec MBSim::DynamicSystemSolver::deltaq ( const fmatvec::Vec &  zParent,
double  t,
double  dt 
)
Returns:
position difference for current time
Parameters:
state
time
timestep
fmatvec::Vec MBSim::DynamicSystemSolver::deltau ( const fmatvec::Vec &  zParent,
double  t,
double  dt 
)
Parameters:
state
time
timestep
Returns:
velocity difference for current time
fmatvec::Vec MBSim::DynamicSystemSolver::deltax ( const fmatvec::Vec &  zParent,
double  t,
double  dt 
)

return x-state difference for current time

Parameters:
parentstate
time
timestep
DynamicSystemSolver* MBSim::DynamicSystemSolver::getDynamicSystemSolver ( )
inline
Returns:
dynamic system solver

Reimplemented from MBSim::Element.

Element* MBSim::DynamicSystemSolver::getElement ( const std::string &  name)
Parameters:
nameof the element
Returns:
the pointer to an element
Todo:
not activated TODO
void MBSim::DynamicSystemSolver::getLinkStatus ( fmatvec::Vector< int > &  LinkStatusExt,
double  t 
)

brief collect status of all set-valued links

Parameters:
resultvector
time
void MBSim::DynamicSystemSolver::getLinkStatusReg ( fmatvec::Vector< int > &  LinkStatusRegExt,
double  t 
)

brief collect status of all single-valued links

Parameters:
resultvector
time
std::string MBSim::DynamicSystemSolver::getSolverInfo ( )
Returns:
information for solver including strategy and linear algebra
virtual void MBSim::DynamicSystemSolver::getsv ( const fmatvec::Vec &  z,
fmatvec::Vec &  svExt,
double  t 
)
virtual

evaluation of stop vector

Parameters:
state
TODO
time
void MBSim::DynamicSystemSolver::init ( InitStage  stage)
virtual

plots time series header

Parameters:
invocingparent class

Reimplemented from MBSim::DynamicSystem.

void MBSim::DynamicSystemSolver::initialize ( )

Initialize the system.

This function calls init(InitStage stage) with all stages defined in the enumeration InitStage, in the order in which they are defined in this enumeration.

The init(InitStage stage) functions of all classes MUST call the init(InitStage stage) functions of all objects for which this class holds as a container. This call is always done at the end of the function independent of the stage.

If the init(InitStage stage) function implements a given stage, the init(InitStage stage) function of the base class should be call or not as expected by the programer for this stage. For all other (not implemented) stages the function of the base call must always be called.

Example for a proper init(InitStage stage) function:

void MyClass::init(InitStage stage) {
if(stage==preInit) {
// do something
MyBaseClass::init(stage); // base must be called
// do something
}
else if(stage==plot) {
// do something
// base need not be called
}
else
for(int i=0; i<container.size(); i++)
container[i]->init(stage);
}
void MBSim::DynamicSystemSolver::initla ( double  dt = 1.0)

load contact force parameter for use as starting value

Todo:
put in dynamic system TODO
void MBSim::DynamicSystemSolver::projectGeneralizedPositions ( double  t,
int  mode 
)

drift projection for positions

Parameters:
time
void MBSim::DynamicSystemSolver::projectGeneralizedVelocities ( double  t,
int  mode 
)

drift projection for positions

Parameters:
time
void MBSim::DynamicSystemSolver::readz0 ( std::string  fileName)

reads state from a file

Parameters:
nameof the file
void MBSim::DynamicSystemSolver::savela ( double  dt = 1.0)

save contact force parameter for use as starting value in next time step

Todo:
put in dynamic system TODO
void MBSim::DynamicSystemSolver::setFlushEvery ( unsigned int  every)
inline

set the number of plot-routine-calls after which all hdf5-files will be flushed

Parameters:
flag
void MBSim::DynamicSystemSolver::setInformationOutput ( bool  INFO_)
inline
Parameters:
decide,whetherinformation should be printed on standard output.
void MBSim::DynamicSystemSolver::setProjectionTolerance ( double  tol)
inline

set tolerance for projection of generalized position

Parameters:
tolerance
void MBSim::DynamicSystemSolver::setReorganizeHierarchy ( bool  flag)
inline

decide, whether the model-hierarchy should be reorganized.

Parameters:
truefor reorganisation, false otherwise
void MBSim::DynamicSystemSolver::setStopIfNoConvergence ( bool  flag,
bool  dropInfo = false 
)
inline
Parameters:
specifywhether time integration should be stopped in case of no convergence of constraint-problem
specifywhether contact informations should be dropped to file
virtual void MBSim::DynamicSystemSolver::shift ( fmatvec::Vec &  z,
const fmatvec::Vector< int > &  jsv,
double  t 
)
virtual

update for event driven integrator for event

Parameters:
state(return)
booleanevaluation of stop vector
time
virtual int MBSim::DynamicSystemSolver::solveConstraints ( )
virtual

solves prox-functions on acceleration level using sparsity structure but not decoupled

Returns:
int MBSim::DynamicSystemSolver::solveConstraintsLinearEquations ( )
Returns:
successful solution of contact equations with Cholesky decomposition on acceleration level
Todo:
put in dynamic system? TODO
int MBSim::DynamicSystemSolver::solveImpactsLinearEquations ( double  dt = 0)
Returns:
successful solution of contact equations with Cholesky decomposition on velocity level
Todo:
put in dynamic system? TODO
void MBSim::DynamicSystemSolver::update ( const fmatvec::Vec &  z,
double  t,
int  options = 0 
)

update of dynamic system for time-stepping integrator

Parameters:
state
time
options= 0 (default) nothing = 1 force updates as if active constraints has changed
void MBSim::DynamicSystemSolver::updateG ( double  t,
int  i = 0 
)

updates mass action matrix

Parameters:
time
virtual void MBSim::DynamicSystemSolver::updater ( double  t,
int  j = 0 
)
virtual

update smooth link force law

    for links holding non-smooth contributions \form#4, the respective forces are projected
    into the minimal coordinate representation of the associated Body%s using the
    JACOBIAN matrices \form#5.

\[ \vr = \vJ\dd\vLambda \]

The JACOBIAN is provided by the connected Frames (which might be user-defined for Joints or internally defined for Contacts).

Parameters:
simulationtime
void MBSim::DynamicSystemSolver::updaterFactors ( )
protectedvirtual

update relaxation factors for contact equations

Todo:
global not available because of unsymmetric mass action matrix TODO

Reimplemented from MBSim::DynamicSystem.

void MBSim::DynamicSystemSolver::updatezdRef ( const fmatvec::Vec &  ext)
protected

references to differentiated external state

Parameters:
differentiatedexternal state
void MBSim::DynamicSystemSolver::updatezRef ( const fmatvec::Vec &  ext)

references to external state

Parameters:
externalstate
void MBSim::DynamicSystemSolver::writez ( std::string  fileName,
bool  formatH5 = true 
)

writes state to a file

Parameters:
nameof the file
h5,elseascii
virtual void MBSim::DynamicSystemSolver::zdot ( const fmatvec::Vec &  z,
fmatvec::Vec &  zd,
double  t 
)
virtual

update for event driven integrator during smooth phase

Parameters:
state
differentiatedstate (return)
time
virtual fmatvec::Vec MBSim::DynamicSystemSolver::zdot ( const fmatvec::Vec &  zParent,
double  t 
)
virtual

standard invocation of smooth update for event driven integration

Parameters:
state
time

Member Data Documentation

bool MBSim::DynamicSystemSolver::reorganizeHierarchy
protected

Flag for reorganisation of hierarchy.

This flag will be removed in the future.

int(DynamicSystemSolver::* MBSim::DynamicSystemSolver::solveConstraints_)()
Returns:
successful flag for function pointer for election of prox-solver on acceleration level
int(DynamicSystemSolver::* MBSim::DynamicSystemSolver::solveImpacts_)(double dt)
Returns:
successful flag for function pointer for election of prox-solver on velocity level
Parameters:
timestep

The documentation for this class was generated from the following file: