tsid
1.8.0
Efficient Task Space Inverse Dynamics for Multi-body Systems based on Pinocchio
|
#include <tsid/contacts/contact-6d.hpp>
Public Types | |
typedef math::ConstRefVector | ConstRefVector |
typedef math::Matrix3x | Matrix3x |
typedef math::Vector6 | Vector6 |
typedef math::Vector3 | Vector3 |
typedef math::Vector | Vector |
typedef tasks::TaskSE3Equality | TaskSE3Equality |
typedef math::ConstraintInequality | ConstraintInequality |
typedef math::ConstraintEquality | ConstraintEquality |
typedef pinocchio::SE3 | SE3 |
![]() | |
typedef math::ConstraintInequality | ConstraintInequality |
typedef math::ConstraintEquality | ConstraintEquality |
typedef math::ConstRefVector | ConstRefVector |
typedef math::Matrix | Matrix |
typedef math::Matrix3x | Matrix3x |
typedef tasks::TaskSE3Equality | TaskSE3Equality |
typedef tasks::TaskMotion | TaskMotion |
typedef pinocchio::Data | Data |
typedef robots::RobotWrapper | RobotWrapper |
Public Member Functions | |
Contact6d (const std::string &name, RobotWrapper &robot, const std::string &frameName, ConstRefMatrix contactPoints, ConstRefVector contactNormal, const double frictionCoefficient, const double minNormalForce, const double maxNormalForce) | |
TSID_DEPRECATED | Contact6d (const std::string &name, RobotWrapper &robot, const std::string &frameName, ConstRefMatrix contactPoints, ConstRefVector contactNormal, const double frictionCoefficient, const double minNormalForce, const double maxNormalForce, const double forceRegWeight) |
unsigned int | n_motion () const override |
Return the number of motion constraints. More... | |
unsigned int | n_force () const override |
Return the number of force variables. More... | |
const ConstraintBase & | computeMotionTask (double t, ConstRefVector q, ConstRefVector v, Data &data) override |
const ConstraintInequality & | computeForceTask (double t, ConstRefVector q, ConstRefVector v, const Data &data) override |
const Matrix & | getForceGeneratorMatrix () override |
const ConstraintEquality & | computeForceRegularizationTask (double t, ConstRefVector q, ConstRefVector v, const Data &data) override |
const TaskSE3Equality & | getMotionTask () const override |
const ConstraintBase & | getMotionConstraint () const override |
const ConstraintInequality & | getForceConstraint () const override |
const ConstraintEquality & | getForceRegularizationTask () const override |
double | getNormalForce (ConstRefVector f) const override |
double | getMinNormalForce () const override |
double | getMaxNormalForce () const override |
const Matrix3x & | getContactPoints () const override |
const Vector & | Kp () const |
const Vector & | Kd () const |
void | Kp (ConstRefVector Kp) |
void | Kd (ConstRefVector Kp) |
bool | setContactPoints (ConstRefMatrix contactPoints) |
bool | setContactNormal (ConstRefVector contactNormal) |
bool | setFrictionCoefficient (double frictionCoefficient) |
bool | setMinNormalForce (double minNormalForce) override |
bool | setMaxNormalForce (double maxNormalForce) override |
void | setReference (const SE3 &ref) |
void | setForceReference (ConstRefVector &f_ref) |
void | setRegularizationTaskWeightVector (ConstRefVector &w) |
![]() | |
ContactBase (const std::string &name, RobotWrapper &robot) | |
virtual | ~ContactBase ()=default |
const std::string & | name () const |
void | name (const std::string &name) |
Public Attributes | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::ConstRefMatrix | ConstRefMatrix |
![]() | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::ConstraintBase | ConstraintBase |
Protected Member Functions | |
void | updateForceInequalityConstraints () |
void | updateForceRegularizationTask () |
void | updateForceGeneratorMatrix () |
Protected Attributes | |
TaskSE3Equality | m_motionTask |
ConstraintInequality | m_forceInequality |
ConstraintEquality | m_forceRegTask |
Matrix3x | m_contactPoints |
Vector3 | m_contactNormal |
Vector6 | m_fRef |
Vector6 | m_weightForceRegTask |
double | m_mu |
double | m_fMin |
double | m_fMax |
Matrix | m_forceGenMat |
![]() | |
std::string | m_name |
RobotWrapper & | m_robot |
Reference on the robot model. More... | |
typedef pinocchio::SE3 tsid::contacts::Contact6d::SE3 |
Contact6d::Contact6d | ( | const std::string & | name, |
RobotWrapper & | robot, | ||
const std::string & | frameName, | ||
ConstRefMatrix | contactPoints, | ||
ConstRefVector | contactNormal, | ||
const double | frictionCoefficient, | ||
const double | minNormalForce, | ||
const double | maxNormalForce | ||
) |
Contact6d::Contact6d | ( | const std::string & | name, |
RobotWrapper & | robot, | ||
const std::string & | frameName, | ||
ConstRefMatrix | contactPoints, | ||
ConstRefVector | contactNormal, | ||
const double | frictionCoefficient, | ||
const double | minNormalForce, | ||
const double | maxNormalForce, | ||
const double | forceRegWeight | ||
) |
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
const Vector & Contact6d::Kd | ( | ) | const |
void Contact6d::Kd | ( | ConstRefVector | Kp | ) |
const Vector & Contact6d::Kp | ( | ) | const |
void Contact6d::Kp | ( | ConstRefVector | Kp | ) |
|
overridevirtual |
Return the number of force variables.
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Return the number of motion constraints.
Implements tsid::contacts::ContactBase.
bool Contact6d::setContactNormal | ( | ConstRefVector | contactNormal | ) |
bool Contact6d::setContactPoints | ( | ConstRefMatrix | contactPoints | ) |
void Contact6d::setForceReference | ( | ConstRefVector & | f_ref | ) |
bool Contact6d::setFrictionCoefficient | ( | double | frictionCoefficient | ) |
|
overridevirtual |
Implements tsid::contacts::ContactBase.
|
overridevirtual |
Implements tsid::contacts::ContactBase.
void Contact6d::setReference | ( | const SE3 & | ref | ) |
void Contact6d::setRegularizationTaskWeightVector | ( | ConstRefVector & | w | ) |
|
protected |
|
protected |
|
protected |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::ConstRefMatrix tsid::contacts::Contact6d::ConstRefMatrix |
|
protected |
|
protected |
|
protected |
|
protected |
|
protected |
|
protected |
|
protected |
|
protected |
|
protected |
|
protected |
|
protected |