#include <body.h>

Inheritance diagram for StaticMass:

Collaboration diagram for StaticMass:

Public Member Functions
	StaticMass (unsigned int uL, const StaticStructDispNode *pNode, doublereal dMass, flag fOut)

virtual	~StaticMass (void)

void	WorkSpaceDim (integer piNumRows, integer piNumCols) const

virtual VariableSubMatrixHandler &	AssJac (VariableSubMatrixHandler &WorkMat, doublereal dCoef, const VectorHandler &XCurr, const VectorHandler &XPrimeCurr)

void	AssMats (VariableSubMatrixHandler &WorkMatA, VariableSubMatrixHandler &WorkMatB, const VectorHandler &XCurr, const VectorHandler &XPrimeCurr)

virtual SubVectorHandler &	AssRes (SubVectorHandler &WorkVec, doublereal dCoef, const VectorHandler &XCurr, const VectorHandler &XPrimeCurr)

virtual bool	bInverseDynamics (void) const

virtual SubVectorHandler &	AssRes (SubVectorHandler &WorkVec, const VectorHandler &, const VectorHandler &, const VectorHandler &, InverseDynamics::Order iOrder=InverseDynamics::INVERSE_DYNAMICS)

virtual void	InitialWorkSpaceDim (integer piNumRows, integer piNumCols) const

virtual VariableSubMatrixHandler &	InitialAssJac (VariableSubMatrixHandler &WorkMat, const VectorHandler &XCurr)

virtual SubVectorHandler &	InitialAssRes (SubVectorHandler &WorkVec, const VectorHandler &XCurr)

virtual void	SetValue (DataManager pDM, VectorHandler &X, VectorHandler &XP, SimulationEntity::Hints ph=0)

Public Member Functions inherited from Elem
	Elem (unsigned int uL, flag fOut)

virtual	~Elem (void)

virtual unsigned int	iGetNumDof (void) const

virtual std::ostream &	DescribeDof (std::ostream &out, const char *prefix="", bool bInitial=false) const

virtual void	DescribeDof (std::vector< std::string > &desc, bool bInitial=false, int i=-1) const

virtual std::ostream &	DescribeEq (std::ostream &out, const char *prefix="", bool bInitial=false) const

virtual void	DescribeEq (std::vector< std::string > &desc, bool bInitial=false, int i=-1) const

virtual DofOrder::Order	GetDofType (unsigned int) const

void	SetInverseDynamicsFlags (unsigned uIDF)

unsigned	GetInverseDynamicsFlags (void) const

bool	bIsErgonomy (void) const

bool	bIsRightHandSide (void) const

virtual VariableSubMatrixHandler &	AssJac (VariableSubMatrixHandler &WorkMat, const VectorHandler &XCurr)

virtual int	GetNumConnectedNodes (void) const

Public Member Functions inherited from WithLabel
	WithLabel (unsigned int uL=0, const std::string &sN="")

virtual	~WithLabel (void)

void	PutLabel (unsigned int uL)

void	PutName (const std::string &sN)

unsigned int	GetLabel (void) const

const std::string &	GetName (void) const

Public Member Functions inherited from SimulationEntity
	SimulationEntity (void)

virtual	~SimulationEntity (void)

virtual bool	bIsValidIndex (unsigned int i) const

virtual DofOrder::Order	GetEqType (unsigned int i) const

virtual Hint *	ParseHint (DataManager pDM, const char s) const

virtual void	BeforePredict (VectorHandler &, VectorHandler &, VectorHandler &, VectorHandler &) const

virtual void	AfterPredict (VectorHandler &X, VectorHandler &XP)

virtual void	Update (const VectorHandler &XCurr, const VectorHandler &XPrimeCurr)

virtual void	DerivativesUpdate (const VectorHandler &XCurr, const VectorHandler &XPrimeCurr)

virtual void	Update (const VectorHandler &XCurr, InverseDynamics::Order iOrder)

virtual void	AfterConvergence (const VectorHandler &X, const VectorHandler &XP)

virtual void	AfterConvergence (const VectorHandler &X, const VectorHandler &XP, const VectorHandler &XPP)

virtual std::ostream &	OutputAppend (std::ostream &out) const

virtual void	ReadInitialState (MBDynParser &HP)

Public Member Functions inherited from ToBeOutput
	ToBeOutput (flag fOut=fDefaultOut)

virtual	~ToBeOutput (void)

virtual void	OutputPrepare (OutputHandler &OH)

virtual void	Output (OutputHandler &OH) const

virtual void	Output (OutputHandler &OH, const VectorHandler &X, const VectorHandler &XP) const

virtual flag	fToBeOutput (void) const

virtual bool	bToBeOutput (void) const

virtual void	SetOutputFlag (flag f=flag(1))

Public Member Functions inherited from Mass
	Mass (unsigned int uL, const StructDispNode *pNode, doublereal dMassTmp, flag fOut)

virtual	~Mass (void)

doublereal	dGetM (void) const

Vec3	GetS (void) const

Mat3x3	GetJ (void) const

const StructDispNode *	pGetNode (void) const

virtual Elem::Type	GetElemType (void) const

virtual unsigned int	iGetInitialNumDof (void) const

virtual unsigned int	iGetNumPrivData (void) const

virtual unsigned int	iGetPrivDataIdx (const char *s) const

virtual doublereal	dGetPrivData (unsigned int i) const

virtual void	GetConnectedNodes (std::vector< const Node * > &connectedNodes) const

Public Member Functions inherited from ElemGravityOwner
	ElemGravityOwner (unsigned int uL, flag fOut)

virtual	~ElemGravityOwner (void)

Vec3	GetS (void) const

Mat3x3	GetJ (void) const

Vec3	GetB (void) const

Vec3	GetG (void) const

Public Member Functions inherited from GravityOwner
	GravityOwner (void)

virtual	~GravityOwner (void)

void	PutGravity (const Gravity *pG)

virtual bool	bGetGravity (const Vec3 &X, Vec3 &Acc) const

Public Member Functions inherited from InitialAssemblyElem
	InitialAssemblyElem (unsigned int uL, flag fOut)

virtual	~InitialAssemblyElem (void)

Public Member Functions inherited from SubjectToInitialAssembly
	SubjectToInitialAssembly (void)

virtual	~SubjectToInitialAssembly (void)

Private Member Functions
bool	AssMats (FullSubMatrixHandler &WorkMatA, FullSubMatrixHandler &WorkMatB, doublereal dCoef)

Additional Inherited Members
Public Types inherited from Elem
enum	Type { UNKNOWN = -1, AIRPROPERTIES = 0, INDUCEDVELOCITY, AUTOMATICSTRUCTURAL, GRAVITY, BODY, JOINT, JOINT_REGULARIZATION, BEAM, PLATE, FORCE, INERTIA, ELECTRICBULK, ELECTRIC, THERMAL, HYDRAULIC, BULK, LOADABLE, DRIVEN, EXTERNAL, AEROMODAL, AERODYNAMIC, GENEL, SOCKETSTREAM_OUTPUT, RTAI_OUTPUT = SOCKETSTREAM_OUTPUT, LASTELEMTYPE }

Public Types inherited from SimulationEntity
typedef std::vector< Hint * >	Hints

Public Types inherited from ToBeOutput
enum	{ OUTPUT = 0x1U, OUTPUT_MASK = 0xFU, OUTPUT_PRIVATE = 0x10U, OUTPUT_PRIVATE_MASK = ~OUTPUT_MASK }

Protected Member Functions inherited from Mass
Vec3	GetS_int (void) const

Mat3x3	GetJ_int (void) const

virtual std::ostream &	Restart (std::ostream &out) const

void	AssVecRBK_int (SubVectorHandler &WorkVec)

void	AssMatsRBK_int (FullSubMatrixHandler &WMA, FullSubMatrixHandler &WMB, const doublereal &dCoef)

Protected Member Functions inherited from ElemGravityOwner
virtual Vec3	GetB_int (void) const

virtual Vec3	GetG_int (void) const

Protected Attributes inherited from WithLabel
unsigned int	uLabel

std::string	sName

Protected Attributes inherited from ToBeOutput
flag	fOutput

Protected Attributes inherited from Mass
const StructDispNode *	pNode

doublereal	dMass

Protected Attributes inherited from GravityOwner
Gravity *	pGravity

Detailed Description

Definition at line 191 of file body.h.

Constructor & Destructor Documentation

StaticMass::StaticMass	(	unsigned int	uL,
		const StaticStructDispNode *	pNode,
		doublereal	dMass,
		flag	fOut
	)

Definition at line 477 of file body.cc.

References NO_OP.

 : Elem(uL, fOut),
 Mass(uL, pNode, dMass, fOut)
 {
         NO_OP;
 }

StaticMass::~StaticMass ( void )

virtual

Definition at line 489 of file body.cc.

References NO_OP.

 {
         NO_OP;
 }

Member Function Documentation

VariableSubMatrixHandler & StaticMass::AssJac	(	VariableSubMatrixHandler &	WorkMat,
		doublereal	dCoef,
		const VectorHandler &	XCurr,
		const VectorHandler &	XPrimeCurr
	)

virtual

Implements Elem.

Definition at line 496 of file body.cc.

References AssMats(), DEBUGCOUTFNAME, StructDispNode::iGetFirstMomentumIndex(), StructDispNode::iGetFirstPositionIndex(), Mass::pNode, FullSubMatrixHandler::PutColIndex(), FullSubMatrixHandler::PutRowIndex(), FullSubMatrixHandler::ResizeReset(), VariableSubMatrixHandler::SetFull(), and VariableSubMatrixHandler::SetNullMatrix().

 {
         DEBUGCOUTFNAME("StaticMass::AssJac");
 
         /* Casting di WorkMat */
         FullSubMatrixHandler& WM = WorkMat.SetFull();
 
         /* Dimensiona e resetta la matrice di lavoro */
         WM.ResizeReset(6, 6);
 
         /* Setta gli indici della matrice - le incognite sono ordinate come:
          *   - posizione (3)
          *   - parametri di rotazione (3)
          *   - quantita' di moto (3)
          *   - momento della quantita' di moto
          * e gli indici sono consecutivi. La funzione pGetFirstPositionIndex()
          * ritorna il valore del primo indice -1, in modo che l'indice i-esimo
          * e' dato da iGetFirstPositionIndex() + i */
         integer iFirstPositionIndex = pNode->iGetFirstPositionIndex();
         integer iFirstMomentumIndex = pNode->iGetFirstMomentumIndex();
         for (integer iCnt = 1; iCnt <= 6; iCnt++) {
                 WM.PutRowIndex(iCnt, iFirstMomentumIndex + iCnt);
                 WM.PutColIndex(iCnt, iFirstPositionIndex + iCnt);
         }
 
         if (AssMats(WM, WM, dCoef)) {
                 WorkMat.SetNullMatrix();
         }
 
         return WorkMat;
 }

Here is the call graph for this function:

bool StaticMass::AssMats	(	FullSubMatrixHandler &	WorkMatA,
		FullSubMatrixHandler &	WorkMatB,
		doublereal	dCoef
	)

private

Definition at line 574 of file body.cc.

References Mass::AssMatsRBK_int(), GravityOwner::bGetGravity(), DEBUGCOUTFNAME, StructDispNode::GetXCurr(), StructDispNode::pGetRBK(), Mass::pNode, and Zero3.

Referenced by AssJac(), and AssMats().

 {
         DEBUGCOUTFNAME("StaticMass::AssMats");
 
         /* Se e' definita l'accelerazione di gravita',
          * la aggiunge (solo al residuo) */
         Vec3 Acceleration(Zero3);
         bool g = GravityOwner::bGetGravity(pNode->GetXCurr(), Acceleration);
 
         const RigidBodyKinematics *pRBK = pNode->pGetRBK();
 
         if (!g && !pRBK) {
                 /* Caller will set WMA & WMB to null matrix */
                 return true;
         }
 
         if (pRBK) {
                 AssMatsRBK_int(WMA, WMB, dCoef);
         }
 
         return false;
 }

Here is the call graph for this function:

void StaticMass::AssMats	(	VariableSubMatrixHandler &	WorkMatA,
		VariableSubMatrixHandler &	WorkMatB,
		const VectorHandler &	XCurr,
		const VectorHandler &	XPrimeCurr
	)

virtual

Reimplemented from Elem.

Definition at line 533 of file body.cc.

References AssMats(), DEBUGCOUTFNAME, StructDispNode::iGetFirstMomentumIndex(), StructDispNode::iGetFirstPositionIndex(), Mass::pNode, FullSubMatrixHandler::PutColIndex(), FullSubMatrixHandler::PutRowIndex(), FullSubMatrixHandler::ResizeReset(), VariableSubMatrixHandler::SetFull(), and VariableSubMatrixHandler::SetNullMatrix().

 {
         DEBUGCOUTFNAME("StaticMass::AssMats");
 
         /* Casting di WorkMat */
         FullSubMatrixHandler& WMA = WorkMatA.SetFull();
         FullSubMatrixHandler& WMB = WorkMatB.SetFull();
 
         /* Dimensiona e resetta la matrice di lavoro */
         WMA.ResizeReset(6, 6);
         WMB.ResizeReset(6, 6);
 
         /* Setta gli indici della matrice - le incognite sono ordinate come:
          *   - posizione (3)
          *   - parametri di rotazione (3)
          *   - quantita' di moto (3)
          *   - momento della quantita' di moto
          * e gli indici sono consecutivi. La funzione pGetFirstPositionIndex()
          * ritorna il valore del primo indice -1, in modo che l'indice i-esimo
          * e' dato da iGetFirstPositionIndex() + i */
         integer iFirstPositionIndex = pNode->iGetFirstPositionIndex();
         integer iFirstMomentumIndex = pNode->iGetFirstMomentumIndex();
         for (integer iCnt = 1; iCnt <= 6; iCnt++) {
                 WMA.PutRowIndex(iCnt, iFirstMomentumIndex + iCnt);
                 WMA.PutColIndex(iCnt, iFirstPositionIndex + iCnt);
 
                 WMB.PutRowIndex(iCnt, iFirstMomentumIndex + iCnt);
                 WMB.PutColIndex(iCnt, iFirstPositionIndex + iCnt);
         }
 
         if (AssMats(WMA, WMB, 1.)) {
                 WorkMatA.SetNullMatrix();
                 WorkMatB.SetNullMatrix();
         }
 }

Here is the call graph for this function:

SubVectorHandler & StaticMass::AssRes	(	SubVectorHandler &	WorkVec,
		doublereal	dCoef,
		const VectorHandler &	XCurr,
		const VectorHandler &	XPrimeCurr
	)

virtual

Implements Elem.

Definition at line 601 of file body.cc.

References VectorHandler::Add(), Mass::AssVecRBK_int(), GravityOwner::bGetGravity(), DEBUGCOUTFNAME, Mass::dMass, StructDispNode::GetXCurr(), StructDispNode::iGetFirstMomentumIndex(), StructDispNode::pGetRBK(), Mass::pNode, SubVectorHandler::PutRowIndex(), VectorHandler::Resize(), VectorHandler::ResizeReset(), and Zero3.

 {
         DEBUGCOUTFNAME("StaticMass::AssRes");
 
         /* Se e' definita l'accelerazione di gravita',
          * la aggiunge (solo al residuo) */
         Vec3 Acceleration(Zero3);
         bool g = GravityOwner::bGetGravity(pNode->GetXCurr(), Acceleration);
 
         /* W is uninitialized because its use is conditioned by w */
         const RigidBodyKinematics *pRBK = pNode->pGetRBK();
 
         if (!g && !pRBK) {
                 WorkVec.Resize(0);
                 return WorkVec;
         }
 
         WorkVec.ResizeReset(3);
 
         integer iFirstMomentumIndex = pNode->iGetFirstMomentumIndex();
         for (integer iCnt = 1; iCnt <= 3; iCnt++) {
                 WorkVec.PutRowIndex(iCnt, iFirstMomentumIndex + iCnt);
         }
 
         if (g) {
                 WorkVec.Add(1, Acceleration*dMass);
         }
 
         if (pRBK) {
                 AssVecRBK_int(WorkVec);
         }
 
         return WorkVec;
 }

Here is the call graph for this function:

SubVectorHandler & StaticMass::AssRes	(	SubVectorHandler &	WorkVec,
		const VectorHandler &	,
		const VectorHandler &	,
		const VectorHandler &	,
		InverseDynamics::Order	iOrder = `InverseDynamics::INVERSE_DYNAMICS`
	)

virtual

Reimplemented from Elem.

Definition at line 649 of file body.cc.

References ASSERT, GravityOwner::bGetGravity(), DEBUGCOUTFNAME, Mass::dMass, StructDispNode::GetXCurr(), StructDispNode::GetXPPCurr(), StructDispNode::iGetFirstPositionIndex(), InverseDynamics::INVERSE_DYNAMICS, Mass::pNode, SubVectorHandler::PutRowIndex(), VectorHandler::ResizeReset(), and VectorHandler::Sub().

 {
         DEBUGCOUTFNAME("DynamicMass::AssRes");
         
         ASSERT(iOrder == InverseDynamics::INVERSE_DYNAMICS);
 
         /* Se e' definita l'accelerazione di gravita', la aggiunge */
         Vec3 GravityAcceleration;
         bool g = GravityOwner::bGetGravity(pNode->GetXCurr(),
                 GravityAcceleration);
 
         WorkVec.ResizeReset(3);
 
         integer iFirstPositionIndex = pNode->iGetFirstPositionIndex();
         for (integer iCnt = 1; iCnt <= 3; iCnt++) {
                 WorkVec.PutRowIndex(iCnt, iFirstPositionIndex + iCnt);
         }
 
         Vec3 Acceleration = pNode->GetXPPCurr();
         if (g) {
                 Acceleration -= GravityAcceleration;
         }
 
         WorkVec.Sub(1, Acceleration*dMass);
 
         return WorkVec;
 }

Here is the call graph for this function:

bool StaticMass::bInverseDynamics ( void ) const

virtual

Reimplemented from Elem.

Definition at line 642 of file body.cc.

 {
         return true;
 }

VariableSubMatrixHandler & StaticMass::InitialAssJac	(	VariableSubMatrixHandler &	WorkMat,
		const VectorHandler &	XCurr
	)

virtual

Implements SubjectToInitialAssembly.

Definition at line 684 of file body.cc.

References DEBUGCOUTFNAME, and VariableSubMatrixHandler::SetNullMatrix().

 {
         DEBUGCOUTFNAME("StaticMass::InitialAssJac");
 
         WorkMat.SetNullMatrix();
 
         return WorkMat;
 }

Here is the call graph for this function:

SubVectorHandler & StaticMass::InitialAssRes	(	SubVectorHandler &	WorkVec,
		const VectorHandler &	XCurr
	)

virtual

Implements SubjectToInitialAssembly.

Definition at line 697 of file body.cc.

References DEBUGCOUTFNAME, and VectorHandler::Resize().

 {
         DEBUGCOUTFNAME("StaticMass::InitialAssRes");
 
         WorkVec.Resize(0);
 
         return WorkVec;
 }

Here is the call graph for this function:

virtual void StaticMass::InitialWorkSpaceDim	(	integer *	piNumRows,
		integer *	piNumCols
	)		const

inlinevirtual

Implements SubjectToInitialAssembly.

Definition at line 246 of file body.h.

                                                                           { 
                 *piNumRows = 3; 
                 *piNumCols = 3; 
         };

void StaticMass::SetValue	(	DataManager *	pDM,
		VectorHandler &	X,
		VectorHandler &	XP,
		SimulationEntity::Hints *	ph = `0`
	)

virtual

Reimplemented from SimulationEntity.

Definition at line 710 of file body.cc.

References NO_OP.

 {
         NO_OP;
 }

void StaticMass::WorkSpaceDim	(	integer *	piNumRows,
		integer *	piNumCols
	)		const

inlinevirtual

Implements Elem.

Definition at line 207 of file body.h.

                                                                         { 
                 *piNumRows = 3; 
                 *piNumCols = 3; 
         };

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

Public Member Functions

Private Member Functions

Additional Inherited Members

Detailed Description

Constructor & Destructor Documentation

Member Function Documentation