Class for constraints on the orientation of a link. More...
#include <kinematic_constraint.h>
Public Member Functions | |
virtual void | clear () |
Clear the stored constraint. More... | |
bool | configure (const moveit_msgs::OrientationConstraint &oc, const robot_state::Transforms &tf) |
Configure the constraint based on a moveit_msgs::OrientationConstraint. More... | |
virtual ConstraintEvaluationResult | decide (const robot_state::RobotState &state, bool verbose=false) const |
Decide whether the constraint is satisfied in the indicated state. More... | |
virtual bool | enabled () const |
This function returns true if this constraint is configured and able to decide whether states do meet the constraint or not. If this function returns false it means that decide() will always return true – there is no constraint to be checked. More... | |
virtual bool | equal (const KinematicConstraint &other, double margin) const |
Check if two orientation constraints are the same. More... | |
const Eigen::Matrix3d & | getDesiredRotationMatrix () const |
The rotation target in the reference frame. More... | |
const robot_model::LinkModel * | getLinkModel () const |
Gets the subject link model. More... | |
const std::string & | getReferenceFrame () const |
The target frame of the planning_models::Transforms class, for interpreting the rotation frame. More... | |
double | getXAxisTolerance () const |
Gets the X axis tolerance. More... | |
double | getYAxisTolerance () const |
Gets the Y axis tolerance. More... | |
double | getZAxisTolerance () const |
Gets the Z axis tolerance. More... | |
bool | mobileReferenceFrame () const |
Whether or not a mobile reference frame is being employed. More... | |
OrientationConstraint (const robot_model::RobotModelConstPtr &model) | |
Constructor. More... | |
virtual void | print (std::ostream &out=std::cout) const |
Print the constraint data. More... | |
Public Member Functions inherited from kinematic_constraints::KinematicConstraint | |
double | getConstraintWeight () const |
The weight of a constraint is a multiplicative factor associated to the distance computed by the decide() function. More... | |
const robot_model::RobotModelConstPtr & | getRobotModel () const |
ConstraintType | getType () const |
Get the type of constraint. More... | |
KinematicConstraint (const robot_model::RobotModelConstPtr &model) | |
Constructor. More... | |
virtual | ~KinematicConstraint () |
Protected Attributes | |
double | absolute_x_axis_tolerance_ |
double | absolute_y_axis_tolerance_ |
double | absolute_z_axis_tolerance_ |
Storage for the tolerances. More... | |
std::string | desired_rotation_frame_id_ |
The target frame of the transform tree. More... | |
Eigen::Matrix3d | desired_rotation_matrix_ |
The desired rotation matrix in the tf frame. More... | |
Eigen::Matrix3d | desired_rotation_matrix_inv_ |
The inverse of the desired rotation matrix, precomputed for efficiency. More... | |
const robot_model::LinkModel * | link_model_ |
The target link model. More... | |
bool | mobile_frame_ |
Whether or not the header frame is mobile or fixed. More... | |
Protected Attributes inherited from kinematic_constraints::KinematicConstraint | |
double | constraint_weight_ |
The weight of a constraint is a multiplicative factor associated to the distance computed by the decide() function. More... | |
robot_model::RobotModelConstPtr | robot_model_ |
The kinematic model associated with this constraint. More... | |
ConstraintType | type_ |
The type of the constraint. More... | |
Additional Inherited Members | |
Public Types inherited from kinematic_constraints::KinematicConstraint | |
enum | ConstraintType { UNKNOWN_CONSTRAINT, JOINT_CONSTRAINT, POSITION_CONSTRAINT, ORIENTATION_CONSTRAINT, VISIBILITY_CONSTRAINT } |
Enum for representing a constraint. More... | |
Class for constraints on the orientation of a link.
This class expresses an orientation constraint on a particular link. The constraint is specified in terms of a quaternion, with tolerances on X,Y, and Z axes. The rotation difference is computed based on the ZXZ Euler angle formulation. The header on the quaternion can be specified in terms of either a fixed frame or a mobile frame. The type value will return ORIENTATION_CONSTRAINT.
Definition at line 348 of file kinematic_constraint.h.
|
inline |
Constructor.
[in] | model | The kinematic model used for constraint evaluation |
Definition at line 359 of file kinematic_constraint.h.
|
virtual |
Clear the stored constraint.
Implements kinematic_constraints::KinematicConstraint.
Definition at line 577 of file kinematic_constraint.cpp.
bool kinematic_constraints::OrientationConstraint::configure | ( | const moveit_msgs::OrientationConstraint & | oc, |
const robot_state::Transforms & | tf | ||
) |
Configure the constraint based on a moveit_msgs::OrientationConstraint.
For the configure command to be successful, the link must exist in the kinematic model. Note that if the absolute tolerance values are left as 0.0 only values less than a very small epsilon will evaluate to satisfied.
[in] | oc | OrientationConstraint for configuration |
Definition at line 493 of file kinematic_constraint.cpp.
|
virtual |
Decide whether the constraint is satisfied in the indicated state.
[in] | state | The kinematic state used for evaluation |
[in] | verbose | Whether or not to print output |
Implements kinematic_constraints::KinematicConstraint.
Definition at line 592 of file kinematic_constraint.cpp.
|
virtual |
This function returns true if this constraint is configured and able to decide whether states do meet the constraint or not. If this function returns false it means that decide() will always return true – there is no constraint to be checked.
Implements kinematic_constraints::KinematicConstraint.
Definition at line 587 of file kinematic_constraint.cpp.
|
virtual |
Check if two orientation constraints are the same.
This means that the types are the same, the subject of the constraint is the same, and all values associated with the constraint are within a margin. The other constraint must also be enabled. For this to be true of orientation constraints:
[in] | other | The other constraint to test |
[in] | margin | The margin to apply to all values associated with constraint |
Implements kinematic_constraints::KinematicConstraint.
Definition at line 559 of file kinematic_constraint.cpp.
|
inline |
The rotation target in the reference frame.
Definition at line 440 of file kinematic_constraint.h.
|
inline |
Gets the subject link model.
Definition at line 408 of file kinematic_constraint.h.
|
inline |
The target frame of the planning_models::Transforms class, for interpreting the rotation frame.
Definition at line 419 of file kinematic_constraint.h.
|
inline |
Gets the X axis tolerance.
Definition at line 451 of file kinematic_constraint.h.
|
inline |
Gets the Y axis tolerance.
Definition at line 462 of file kinematic_constraint.h.
|
inline |
Gets the Z axis tolerance.
Definition at line 473 of file kinematic_constraint.h.
|
inline |
Whether or not a mobile reference frame is being employed.
Definition at line 430 of file kinematic_constraint.h.
|
virtual |
Print the constraint data.
[in] | out | The file descriptor for printing |
Reimplemented from kinematic_constraints::KinematicConstraint.
Definition at line 633 of file kinematic_constraint.cpp.
|
protected |
Definition at line 486 of file kinematic_constraint.h.
|
protected |
Definition at line 486 of file kinematic_constraint.h.
|
protected |
Storage for the tolerances.
Definition at line 486 of file kinematic_constraint.h.
|
protected |
The target frame of the transform tree.
Definition at line 484 of file kinematic_constraint.h.
|
protected |
The desired rotation matrix in the tf frame.
Definition at line 480 of file kinematic_constraint.h.
|
protected |
The inverse of the desired rotation matrix, precomputed for efficiency.
Definition at line 481 of file kinematic_constraint.h.
|
protected |
The target link model.
Definition at line 479 of file kinematic_constraint.h.
|
protected |
Whether or not the header frame is mobile or fixed.
Definition at line 485 of file kinematic_constraint.h.