A class that contains many different constraints, and can check RobotState *versus the full set. A set is satisfied if and only if all constraints are satisfied. More...

#include <kinematic_constraint.h>

Public Member Functions
bool	add (const moveit_msgs::Constraints &c, const moveit::core::Transforms &tf)
	Add all known constraints. More...

bool	add (const std::vector< moveit_msgs::JointConstraint > &jc)
	Add a vector of joint constraints. More...

bool	add (const std::vector< moveit_msgs::OrientationConstraint > &oc, const moveit::core::Transforms &tf)
	Add a vector of orientation constraints. More...

bool	add (const std::vector< moveit_msgs::PositionConstraint > &pc, const moveit::core::Transforms &tf)
	Add a vector of position constraints. More...

bool	add (const std::vector< moveit_msgs::VisibilityConstraint > &vc, const moveit::core::Transforms &tf)
	Add a vector of visibility constraints. More...

void	clear ()
	Clear the stored constraints. More...

ConstraintEvaluationResult	decide (const moveit::core::RobotState &state, bool verbose=false) const
	Determines whether all constraints are satisfied by state, returning a single evaluation result. More...

ConstraintEvaluationResult	decide (const moveit::core::RobotState &state, std::vector< ConstraintEvaluationResult > &results, bool verbose=false) const
	Determines whether all constraints are satisfied by state, returning a vector of results through a parameter in addition to a summed result. More...

bool	empty () const
	Returns whether or not there are any constraints in the set. More...

bool	equal (const KinematicConstraintSet &other, double margin) const
	Whether or not another KinematicConstraintSet is equal to this one. More...

const moveit_msgs::Constraints &	getAllConstraints () const
	Get all constraints in the set. More...

const std::vector< moveit_msgs::JointConstraint > &	getJointConstraints () const
	Get all joint constraints in the set. More...

const std::vector< moveit_msgs::OrientationConstraint > &	getOrientationConstraints () const
	Get all orientation constraints in the set. More...

const std::vector< moveit_msgs::PositionConstraint > &	getPositionConstraints () const
	Get all position constraints in the set. More...

const std::vector< moveit_msgs::VisibilityConstraint > &	getVisibilityConstraints () const
	Get all visibility constraints in the set. More...

	KinematicConstraintSet (const moveit::core::RobotModelConstPtr &model)
	Constructor. More...

void	print (std::ostream &out=std::cout) const
	Print the constraint data. More...

	~KinematicConstraintSet ()

Protected Attributes
moveit_msgs::Constraints	all_constraints_
	Messages corresponding to all internal constraints. More...

std::vector< moveit_msgs::JointConstraint >	joint_constraints_
	Messages corresponding to all internal joint constraints. More...

std::vector< KinematicConstraintPtr >	kinematic_constraints_
	Shared pointers to all the member constraints. More...

std::vector< moveit_msgs::OrientationConstraint >	orientation_constraints_
	Messages corresponding to all internal orientation constraints. More...

std::vector< moveit_msgs::PositionConstraint >	position_constraints_
	Messages corresponding to all internal position constraints. More...

moveit::core::RobotModelConstPtr	robot_model_
	The kinematic model used for by the Set. More...

std::vector< moveit_msgs::VisibilityConstraint >	visibility_constraints_
	Messages corresponding to all internal visibility constraints. More...

Detailed Description

A class that contains many different constraints, and can check RobotState *versus the full set. A set is satisfied if and only if all constraints are satisfied.

The set may contain any number of different kinds of constraints. All constraints, including invalid ones, are stored internally.

Definition at line 923 of file kinematic_constraint.h.

Constructor & Destructor Documentation

◆ KinematicConstraintSet()

kinematic_constraints::KinematicConstraintSet::KinematicConstraintSet ( const moveit::core::RobotModelConstPtr & model )

inline

Constructor.

Parameters

[in] model The kinematic model used for constraint evaluation

Definition at line 934 of file kinematic_constraint.h.

◆ ~KinematicConstraintSet()

kinematic_constraints::KinematicConstraintSet::~KinematicConstraintSet ( )

inline

Definition at line 938 of file kinematic_constraint.h.

Member Function Documentation

◆ add() [1/5]

bool kinematic_constraints::KinematicConstraintSet::add	(	const moveit_msgs::Constraints &	c,
		const moveit::core::Transforms &	tf
	)

Add all known constraints.

Parameters

[in] c A message potentially contain vectors of constraints of add types

Returns: Whether or not all constraints could be successfully configured given the contents of the message. The KinematicConstraintSet can still be used even if the addition returns false.

Definition at line 1275 of file kinematic_constraint.cpp.

◆ add() [2/5]

bool kinematic_constraints::KinematicConstraintSet::add ( const std::vector< moveit_msgs::JointConstraint > & jc )

Add a vector of joint constraints.

Parameters

[in] jc A vector of joint constraints

Returns: Will return true only if all constraints are valid, and false otherwise

Definition at line 1212 of file kinematic_constraint.cpp.

◆ add() [3/5]

bool kinematic_constraints::KinematicConstraintSet::add	(	const std::vector< moveit_msgs::OrientationConstraint > &	oc,
		const moveit::core::Transforms &	tf
	)

Add a vector of orientation constraints.

Parameters

[in] oc A vector of orientation constraints

Returns: Will return true only if all constraints are valid, and false otherwise

Definition at line 1243 of file kinematic_constraint.cpp.

◆ add() [4/5]

bool kinematic_constraints::KinematicConstraintSet::add	(	const std::vector< moveit_msgs::PositionConstraint > &	pc,
		const moveit::core::Transforms &	tf
	)

Add a vector of position constraints.

Parameters

[in] pc A vector of position constraints

Returns: Will return true only if all constraints are valid, and false otherwise

Definition at line 1227 of file kinematic_constraint.cpp.

◆ add() [5/5]

bool kinematic_constraints::KinematicConstraintSet::add	(	const std::vector< moveit_msgs::VisibilityConstraint > &	vc,
		const moveit::core::Transforms &	tf
	)

Add a vector of visibility constraints.

Parameters

[in] vc A vector of visibility constraints

Returns: Will return true only if all constraints are valid, and false otherwise

Definition at line 1259 of file kinematic_constraint.cpp.

◆ clear()

void kinematic_constraints::KinematicConstraintSet::clear ( )

Clear the stored constraints.

Definition at line 1202 of file kinematic_constraint.cpp.

◆ decide() [1/2]

ConstraintEvaluationResult kinematic_constraints::KinematicConstraintSet::decide	(	const moveit::core::RobotState &	state,
		bool	verbose = `false`
	)		const

Determines whether all constraints are satisfied by state, returning a single evaluation result.

Parameters

[in]	state	The state to test
[in]	verbose	Whether or not to make each constraint give debug output

Returns: A single constraint evaluation result, where it will report satisfied only if all constraints are satisfied, and with a distance that is the sum of all individual distances.

Definition at line 1284 of file kinematic_constraint.cpp.

◆ decide() [2/2]

ConstraintEvaluationResult kinematic_constraints::KinematicConstraintSet::decide	(	const moveit::core::RobotState &	state,
		std::vector< ConstraintEvaluationResult > &	results,
		bool	verbose = `false`
	)		const

Determines whether all constraints are satisfied by state, returning a vector of results through a parameter in addition to a summed result.

Parameters

[in]	state	The state to test
[out]	results	The individual results from constraint evaluation on each constraint contained in the set.
[in]	verbose	Whether to print the results of each constraint check.

Returns: A single constraint evaluation result, where it will report satisfied only if all constraints are satisfied, and with a distance that is the sum of all individual distances.

Definition at line 1297 of file kinematic_constraint.cpp.

◆ empty()

bool kinematic_constraints::KinematicConstraintSet::empty ( ) const

inline

Returns whether or not there are any constraints in the set.

Returns: True if there are no constraints, otherwise false.

Definition at line 1113 of file kinematic_constraint.h.

◆ equal()

bool kinematic_constraints::KinematicConstraintSet::equal	(	const KinematicConstraintSet &	other,
		double	margin
	)		const

Whether or not another KinematicConstraintSet is equal to this one.

Equality means that for each constraint in this set there is a constraint in the other set for which equal() is true with the given margin. Multiple constraints in this set can be matched to single constraints in the other set. Some constraints in the other set may not be matched to constraints in this set.

Parameters

[in]	other	The other set against which to test
[in]	margin	The margin to apply to all individual constraint equality tests

Returns: True if all constraints are matched, false otherwise

Definition at line 1320 of file kinematic_constraint.cpp.

◆ getAllConstraints()

const moveit_msgs::Constraints& kinematic_constraints::KinematicConstraintSet::getAllConstraints ( ) const

inline

Get all constraints in the set.

Returns: All constraints in a single message

Definition at line 1102 of file kinematic_constraint.h.

◆ getJointConstraints()

const std::vector<moveit_msgs::JointConstraint>& kinematic_constraints::KinematicConstraintSet::getJointConstraints ( ) const

inline

Get all joint constraints in the set.

Returns: All joint constraints

Definition at line 1080 of file kinematic_constraint.h.

◆ getOrientationConstraints()

const std::vector<moveit_msgs::OrientationConstraint>& kinematic_constraints::KinematicConstraintSet::getOrientationConstraints ( ) const

inline

Get all orientation constraints in the set.

Returns: All orientation constraints

Definition at line 1069 of file kinematic_constraint.h.

◆ getPositionConstraints()

const std::vector<moveit_msgs::PositionConstraint>& kinematic_constraints::KinematicConstraintSet::getPositionConstraints ( ) const

inline

Get all position constraints in the set.

Returns: All position constraints

Definition at line 1058 of file kinematic_constraint.h.

◆ getVisibilityConstraints()

const std::vector<moveit_msgs::VisibilityConstraint>& kinematic_constraints::KinematicConstraintSet::getVisibilityConstraints ( ) const

inline

Get all visibility constraints in the set.

Returns: All visibility constraints

Definition at line 1091 of file kinematic_constraint.h.

◆ print()

void kinematic_constraints::KinematicConstraintSet::print ( std::ostream & out = std::cout ) const

Print the constraint data.

Parameters

[in] out The file stream for printing

Definition at line 1313 of file kinematic_constraint.cpp.

Member Data Documentation

◆ all_constraints_

moveit_msgs::Constraints kinematic_constraints::KinematicConstraintSet::all_constraints_

protected

Messages corresponding to all internal constraints.

Definition at line 1131 of file kinematic_constraint.h.

◆ joint_constraints_

std::vector<moveit_msgs::JointConstraint> kinematic_constraints::KinematicConstraintSet::joint_constraints_

protected

Messages corresponding to all internal joint constraints.

Definition at line 1123 of file kinematic_constraint.h.

◆ kinematic_constraints_

std::vector<KinematicConstraintPtr> kinematic_constraints::KinematicConstraintSet::kinematic_constraints_

protected

Shared pointers to all the member constraints.

Definition at line 1121 of file kinematic_constraint.h.

◆ orientation_constraints_

std::vector<moveit_msgs::OrientationConstraint> kinematic_constraints::KinematicConstraintSet::orientation_constraints_

protected

Messages corresponding to all internal orientation constraints.

Definition at line 1127 of file kinematic_constraint.h.

◆ position_constraints_

std::vector<moveit_msgs::PositionConstraint> kinematic_constraints::KinematicConstraintSet::position_constraints_

protected

Messages corresponding to all internal position constraints.

Definition at line 1125 of file kinematic_constraint.h.

◆ robot_model_

moveit::core::RobotModelConstPtr kinematic_constraints::KinematicConstraintSet::robot_model_

protected

The kinematic model used for by the Set.

Definition at line 1119 of file kinematic_constraint.h.

◆ visibility_constraints_

std::vector<moveit_msgs::VisibilityConstraint> kinematic_constraints::KinematicConstraintSet::visibility_constraints_

protected

Messages corresponding to all internal visibility constraints.

Definition at line 1129 of file kinematic_constraint.h.

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

Public Member Functions

Protected Attributes

Detailed Description

Constructor & Destructor Documentation

◆ KinematicConstraintSet()

◆ ~KinematicConstraintSet()

Member Function Documentation

◆ add() [1/5]

◆ add() [2/5]

◆ add() [3/5]

◆ add() [4/5]

◆ add() [5/5]

◆ clear()

◆ decide() [1/2]

◆ decide() [2/2]

◆ empty()

◆ equal()

◆ getAllConstraints()

◆ getJointConstraints()

◆ getOrientationConstraints()

◆ getPositionConstraints()

◆ getVisibilityConstraints()

◆ print()

Member Data Documentation

◆ all_constraints_

◆ joint_constraints_

◆ kinematic_constraints_

◆ orientation_constraints_

◆ position_constraints_

◆ robot_model_

◆ visibility_constraints_