16 #ifndef SURGSIM_PHYSICS_RIGIDREPRESENTATION_H 17 #define SURGSIM_PHYSICS_RIGIDREPRESENTATION_H 97 void update(
double dt)
override;
101 void applyCorrection(
double dt,
const Eigen::VectorBlock<SurgSim::Math::Vector>& deltaVelocity)
override;
144 #endif // SURGSIM_PHYSICS_RIGIDREPRESENTATION_H Definition: CompoundShapeToGraphics.cpp:29
virtual ~RigidRepresentation()
Destructor.
Definition: RigidRepresentation.cpp:53
Eigen::Matrix< double, 6, 6, Eigen::RowMajor > Matrix66d
A 6x6 matrix of doubles.
Definition: Matrix.h:59
RigidRepresentation(const std::string &name)
Constructor.
Definition: RigidRepresentation.cpp:36
const SurgSim::Math::Matrix66d & getExternalGeneralizedDamping() const
Definition: RigidRepresentation.cpp:191
SurgSim::Math::Matrix33d m_globalInertia
Inertia matrices in global coordinates.
Definition: RigidRepresentation.h:109
A Location defines a local position w.r.t.
Definition: Location.h:39
SurgSim::DataStructures::BufferedValue< SurgSim::Math::Vector6d > & getExternalGeneralizedForce()
Definition: RigidRepresentation.cpp:181
RigidLocalization RigidLocalization
Definition: RigidRepresentation.h:32
The RigidRepresentation class defines the dynamic rigid body representation Note that the rigid repre...
Definition: RigidRepresentation.h:42
bool m_hasExternalGeneralizedForce
External generalized force, stiffness and damping applied on the rigid representation.
Definition: RigidRepresentation.h:123
SurgSim::Math::Matrix66d m_externalGeneralizedStiffness
External generalized force, stiffness and damping applied on the rigid representation.
Definition: RigidRepresentation.h:125
Eigen::Matrix< double, 6, 1 > Vector6d
A 6D matrix of doubles.
Definition: Vector.h:65
The RigidRepresentationBase class defines the base class for all rigid motion based representations (...
Definition: RigidRepresentationBase.h:38
void setAngularVelocity(const SurgSim::Math::Vector3d &angularVelocity)
Set the current angular velocity of the rigid representation.
Definition: RigidRepresentation.cpp:470
The RigidState class describes a state (position and velocity information).
Definition: RigidState.h:31
SurgSim::Math::Vector3d m_force
Current force applied on the rigid representation (in N)
Definition: RigidRepresentation.h:114
SurgSim::Math::Matrix66d m_C
Compliance matrix (size of the number of Dof = 6)
Definition: RigidRepresentation.h:119
void setLinearVelocity(const SurgSim::Math::Vector3d &linearVelocity)
Set the current linear velocity of the rigid representation.
Definition: RigidRepresentation.cpp:465
This class implements the localization on a RigidRepresentationBase, as a local position.
Definition: RigidLocalization.h:31
Definitions of small fixed-size square matrix types.
SURGSIM_CLASSNAME(SurgSim::Physics::RigidRepresentation)
SurgSim::Math::Matrix33d m_invGlobalInertia
Inverse of inertia matrix in global coordinates.
Definition: RigidRepresentation.h:111
Definitions of small fixed-size vector types.
void addExternalGeneralizedForce(const SurgSim::Math::Vector6d &generalizedForce, const SurgSim::Math::Matrix66d &K=SurgSim::Math::Matrix66d::Zero(), const SurgSim::Math::Matrix66d &D=SurgSim::Math::Matrix66d::Zero())
Add an external generalized force applied to the rigid representation's mass center.
Definition: RigidRepresentation.cpp:57
SurgSim::DataStructures::BufferedValue< SurgSim::Math::Vector6d > m_externalGeneralizedForce
External generalized force, stiffness and damping applied on the rigid representation.
Definition: RigidRepresentation.h:124
SurgSim::Math::Matrix66d m_externalGeneralizedDamping
External generalized force, stiffness and damping applied on the rigid representation.
Definition: RigidRepresentation.h:126
void afterUpdate(double dt) override
Postprocessing done after the update call This needs to be called from the outside usually from a Com...
Definition: RigidRepresentation.cpp:314
void updateGlobalInertiaMatrices(const RigidState &state) override
Update global inertia matrices (internal data structure)
Definition: RigidRepresentation.cpp:438
void beforeUpdate(double dt) override
Preprocessing done before the update call This needs to be called from the outside usually from a Com...
Definition: RigidRepresentation.cpp:196
SurgSim::Math::Vector3d m_torque
Current torque applied on the rigid representation (in N.m)
Definition: RigidRepresentation.h:116
Eigen::Matrix< double, 3, 3, Eigen::RowMajor > Matrix33d
A 3x3 matrix of doubles.
Definition: Matrix.h:51
void applyCorrection(double dt, const Eigen::VectorBlock< SurgSim::Math::Vector > &deltaVelocity) override
Update the Representation's current position and velocity using a time interval, dt, and change in velocity, deltaVelocity.
Definition: RigidRepresentation.cpp:338
const SurgSim::Math::Matrix66d & getComplianceMatrix() const
Retrieve the rigid body 6x6 compliance matrix.
Definition: RigidRepresentation.cpp:404
bool doInitialize() override
Interface to be implemented by derived classes.
Definition: RigidRepresentation.cpp:453
void computeComplianceMatrix(double dt)
Compute compliance matrix (internal data structure)
Definition: RigidRepresentation.cpp:409
const SurgSim::Math::Matrix66d & getExternalGeneralizedStiffness() const
Definition: RigidRepresentation.cpp:186
This class localize a point on a representation (representation specific)
Definition: Localization.h:39
Eigen::Matrix< double, 3, 1 > Vector3d
A 3D vector of doubles.
Definition: Vector.h:57
void update(double dt) override
Update the representation state to the current time step.
Definition: RigidRepresentation.cpp:210