#include <Tasks/QPContacts.h>

Collaboration diagram for tasks::qp::BilateralContact:

Public Member Functions
	BilateralContact ()

	BilateralContact (int r1Index, int r2Index, const std::string &r1BodyName, const std::string &r2BodyName, std::vector< Eigen::Vector3d > r1Points, const std::vector< Eigen::Matrix3d > &r1Frames, const sva::PTransformd &X_b1_b2, int nrGen, double mu, const sva::PTransformd &X_b1_cf=sva::PTransformd::Identity())

	BilateralContact (int r1Index, int r2Index, const std::string &r1BodyName, const std::string &r2BodyName, int ambId, std::vector< Eigen::Vector3d > r1Points, const std::vector< Eigen::Matrix3d > &r1Frames, const sva::PTransformd &X_b1_b2, int nrGen, double mu, const sva::PTransformd &X_b1_cf=sva::PTransformd::Identity())

	BilateralContact (const ContactId &cId, std::vector< Eigen::Vector3d > r1Points, const std::vector< Eigen::Matrix3d > &r1Frames, const sva::PTransformd &X_b1_b2, int nrGen, double mu, const sva::PTransformd &X_b1_cf=sva::PTransformd::Identity())

	BilateralContact (const UnilateralContact &c)

Eigen::Vector3d	force (const Eigen::VectorXd &lambda, int point, const std::vector< FrictionCone > &c) const

Eigen::Vector3d	force (const Eigen::VectorXd &lambda, const std::vector< FrictionCone > &c) const

sva::ForceVecd	force (const Eigen::VectorXd &lambda, const std::vector< Eigen::Vector3d > &r_b_pi, const std::vector< FrictionCone > &c_pi_b) const

int	nrLambda (int point) const

int	nrLambda () const

Eigen::Vector3d	sForce (const Eigen::VectorXd &lambda, int point, const std::vector< FrictionCone > &c) const

Eigen::Vector3d	sForce (const Eigen::VectorXd &lambda, const std::vector< FrictionCone > &c) const

sva::ForceVecd	sForce (const Eigen::VectorXd &lambda, const std::vector< Eigen::Vector3d > &r_b_pi, const std::vector< FrictionCone > &c_pi_b) const

int	sNrLambda (int point) const

Public Attributes
ContactId	contactId

std::vector< Eigen::Vector3d >	r1Points

std::vector< Eigen::Vector3d >	r2Points

std::vector< FrictionCone >	r1Cones

std::vector< FrictionCone >	r2Cones

sva::PTransformd	X_b1_b2

sva::PTransformd	X_b1_cf

Detailed Description

Model of a generic contacts. Friction cone frame can be different for each contact points.

Constructor & Destructor Documentation

◆ BilateralContact() [1/5]

tasks::qp::BilateralContact::BilateralContact ( )

inline

◆ BilateralContact() [2/5]

tasks::qp::BilateralContact::BilateralContact	(	int	r1Index,
		int	r2Index,
		const std::string &	r1BodyName,
		const std::string &	r2BodyName,
		std::vector< Eigen::Vector3d >	r1Points,
		const std::vector< Eigen::Matrix3d > &	r1Frames,
		const sva::PTransformd &	X_b1_b2,
		int	nrGen,
		double	mu,
		const sva::PTransformd &	X_b1_cf = `sva::PTransformd::Identity()`
	)

Parameters

r1Index	First robot imply in the contact.
r2Index	Second robot imply in the contact.
r1BodyName	Body name of robot r1Index imply in the contact.
r2BodyName	Body name of robot r2Index imply in the contact.
r1Points	Contact points in r1BodyId frame.
r1Frames	Friction cone frame in r1Points order in rbBodyId frame.
X_b1_b2	Transformation between r1BodyId and r2BodyId frame.
nrGen	Number of generatrix.
mu	Coefficient of friction.
X_b1_cf	Define the \( cf \) frame (common frame) used in the contact constraints.

See also: ContactConstrCommon::addDofContact

◆ BilateralContact() [3/5]

tasks::qp::BilateralContact::BilateralContact	(	int	r1Index,
		int	r2Index,
		const std::string &	r1BodyName,
		const std::string &	r2BodyName,
		int	ambId,
		std::vector< Eigen::Vector3d >	r1Points,
		const std::vector< Eigen::Matrix3d > &	r1Frames,
		const sva::PTransformd &	X_b1_b2,
		int	nrGen,
		double	mu,
		const sva::PTransformd &	X_b1_cf = `sva::PTransformd::Identity()`
	)

Parameters

r1Index	First robot imply in the contact.
r2Index	Second robot imply in the contact.
r1BodyName	Body id of robot r1Index imply in the contact.
r2BodyName	Body id of robot r2Index imply in the contact.
ambId	ambiguityId.
r1Points	Contact points in r1BodyId frame.
r1Frames	Friction cone frame in r1Points order in rbBodyId frame.
X_b1_b2	Transformation between r1BodyId and r2BodyId frame.
nrGen	Number of generatrix.
mu	Coefficient of friction.
X_b1_cf	Define the \( cf \) frame (common frame) used in the contact constraints.

See also: ContactConstrCommon::addDofContact; ContactId::ContactId

◆ BilateralContact() [4/5]

tasks::qp::BilateralContact::BilateralContact	(	const ContactId &	cId,
		std::vector< Eigen::Vector3d >	r1Points,
		const std::vector< Eigen::Matrix3d > &	r1Frames,
		const sva::PTransformd &	X_b1_b2,
		int	nrGen,
		double	mu,
		const sva::PTransformd &	X_b1_cf = `sva::PTransformd::Identity()`
	)

Parameters

cId	Contact id.
r1Points	Contact points in r1BodyId frame.
r1Frames	Friction cone frame in r1Points order in rbBodyId frame.
X_b1_b2	Transformation between r1BodyId and r2BodyId frame.
nrGen	Number of generatrix.
mu	Coefficient of friction.
X_b1_cf	Define the \( cf \) frame (common frame) used in the contact constraints.

See also: ContactConstrCommon::addDofContact

◆ BilateralContact() [5/5]

tasks::qp::BilateralContact::BilateralContact ( const UnilateralContact & c )

Construct a BilateralContact from an UnilateralContact.

Member Function Documentation

◆ force() [1/3]

sva::ForceVecd tasks::qp::BilateralContact::force	(	const Eigen::VectorXd &	lambda,
		const std::vector< Eigen::Vector3d > &	r_b_pi,
		const std::vector< FrictionCone > &	c_pi_b
	)		const

Compute force applied on the body origin in the body frame.

Parameters

lambda	Linearized contact forces.
r_b_pi	List of transformation r_b_pi (body origin to point i).
c_pi_b	Frictions cones associated with each point in body frame.

Returns: F_b, the 6D force applied on the body origin at the body frame.

◆ force() [2/3]

Eigen::Vector3d tasks::qp::BilateralContact::force	(	const Eigen::VectorXd &	lambda,
		const std::vector< FrictionCone > &	c
	)		const

Returns: Cones c force vector in body coordinate.

◆ force() [3/3]

Eigen::Vector3d tasks::qp::BilateralContact::force	(	const Eigen::VectorXd &	lambda,
		int	point,
		const std::vector< FrictionCone > &	c
	)		const

Returns: Cone c[point] force vector in body coordinate.

◆ nrLambda() [1/2]

int tasks::qp::BilateralContact::nrLambda ( ) const

Returns: Number of lambda needed to compute the force vector.

◆ nrLambda() [2/2]

int tasks::qp::BilateralContact::nrLambda ( int point ) const

Returns: Number of lambda needed to compute the force vector of the contact point.

◆ sForce() [1/3]

sva::ForceVecd tasks::qp::BilateralContact::sForce	(	const Eigen::VectorXd &	lambda,
		const std::vector< Eigen::Vector3d > &	r_b_pi,
		const std::vector< FrictionCone > &	c_pi_b
	)		const

Safe version of

See also: force.

Exceptions

std::domain_error If lambda don't match the number of generator.

◆ sForce() [2/3]

Eigen::Vector3d tasks::qp::BilateralContact::sForce	(	const Eigen::VectorXd &	lambda,
		const std::vector< FrictionCone > &	c
	)		const

Safe version of

See also: force. Also the generic one for python binding.

Exceptions

std::domain_error If lambda don't match the number of generator.

◆ sForce() [3/3]

Eigen::Vector3d tasks::qp::BilateralContact::sForce	(	const Eigen::VectorXd &	lambda,
		int	point,
		const std::vector< FrictionCone > &	c
	)		const

Safe version of

See also: force. Also the generic one for python binding.

Exceptions

std::domain_error If lambda don't match the number of generator or if point it not a valid index.

◆ sNrLambda()

int tasks::qp::BilateralContact::sNrLambda ( int point ) const

Safe version of

See also: nrLambda.

Exceptions

std::domain_error If point is not a valid index.

Member Data Documentation

◆ contactId

ContactId tasks::qp::BilateralContact::contactId

◆ r1Cones

std::vector<FrictionCone> tasks::qp::BilateralContact::r1Cones

◆ r1Points

std::vector<Eigen::Vector3d> tasks::qp::BilateralContact::r1Points

◆ r2Cones

std::vector<FrictionCone> tasks::qp::BilateralContact::r2Cones

◆ r2Points

std::vector<Eigen::Vector3d> tasks::qp::BilateralContact::r2Points

◆ X_b1_b2

sva::PTransformd tasks::qp::BilateralContact::X_b1_b2

◆ X_b1_cf

sva::PTransformd tasks::qp::BilateralContact::X_b1_cf

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

src/Tasks/QPContacts.h

Public Member Functions

Public Attributes

Detailed Description

Constructor & Destructor Documentation

◆ BilateralContact() [1/5]

◆ BilateralContact() [2/5]

◆ BilateralContact() [3/5]

◆ BilateralContact() [4/5]

◆ BilateralContact() [5/5]

Member Function Documentation

◆ force() [1/3]

◆ force() [2/3]

◆ force() [3/3]

◆ nrLambda() [1/2]

◆ nrLambda() [2/2]

◆ sForce() [1/3]

◆ sForce() [2/3]

◆ sForce() [3/3]

◆ sNrLambda()

Member Data Documentation

◆ contactId

◆ r1Cones

◆ r1Points

◆ r2Cones

◆ r2Points

◆ X_b1_b2

◆ X_b1_cf