#include <kinematic_state_constraint_evaluator.h>
Public Member Functions | |
virtual void | clear (void) |
Clear the stored constraint. | |
virtual bool | decide (const planning_models::KinematicState *state, bool verbose=false) const |
Decide whether the constraint is satisfied in the indicated state or group, if specified. | |
bool | decide (double dAng, bool verbose=false) const |
Decide whether the constraint is satisfied. The distances to the position and to the orientation are given. | |
void | evaluate (const planning_models::KinematicState *state, double &distAng, bool verbose=false) const |
Evaluate the distances to the position and to the orientation are given. | |
const arm_navigation_msgs::OrientationConstraint & | getConstraintMessage (void) const |
Get the constraint message. | |
OrientationConstraintEvaluator (void) | |
void | print (std::ostream &out=std::cout) const |
Print the constraint data. | |
bool | use (const arm_navigation_msgs::OrientationConstraint &pc) |
This function assumes the constraint has been transformed into the proper frame, if such a transform is needed. | |
Protected Attributes | |
boost::scoped_ptr< bodies::Body > | m_constraint_region |
arm_navigation_msgs::OrientationConstraint | m_oc |
double | m_pitch |
double | m_roll |
tf::Matrix3x3 | m_rotation_matrix |
double | m_yaw |
Definition at line 114 of file kinematic_state_constraint_evaluator.h.
planning_environment::OrientationConstraintEvaluator::OrientationConstraintEvaluator | ( | void | ) | [inline] |
Definition at line 118 of file kinematic_state_constraint_evaluator.h.
void planning_environment::OrientationConstraintEvaluator::clear | ( | void | ) | [virtual] |
Clear the stored constraint.
Implements planning_environment::KinematicConstraintEvaluator.
Definition at line 207 of file kinematic_state_constraint_evaluator.cpp.
bool planning_environment::OrientationConstraintEvaluator::decide | ( | const planning_models::KinematicState * | state, |
bool | verbose = false |
||
) | const [virtual] |
Decide whether the constraint is satisfied in the indicated state or group, if specified.
Implements planning_environment::KinematicConstraintEvaluator.
Definition at line 237 of file kinematic_state_constraint_evaluator.cpp.
bool planning_environment::OrientationConstraintEvaluator::decide | ( | double | dAng, |
bool | verbose = false |
||
) | const |
Decide whether the constraint is satisfied. The distances to the position and to the orientation are given.
Definition at line 344 of file kinematic_state_constraint_evaluator.cpp.
void planning_environment::OrientationConstraintEvaluator::evaluate | ( | const planning_models::KinematicState * | state, |
double & | distAng, | ||
bool | verbose = false |
||
) | const |
Evaluate the distances to the position and to the orientation are given.
Definition at line 309 of file kinematic_state_constraint_evaluator.cpp.
const arm_navigation_msgs::OrientationConstraint & planning_environment::OrientationConstraintEvaluator::getConstraintMessage | ( | void | ) | const |
Get the constraint message.
Definition at line 354 of file kinematic_state_constraint_evaluator.cpp.
void planning_environment::OrientationConstraintEvaluator::print | ( | std::ostream & | out = std::cout | ) | const [virtual] |
Print the constraint data.
Reimplemented from planning_environment::KinematicConstraintEvaluator.
Definition at line 403 of file kinematic_state_constraint_evaluator.cpp.
bool planning_environment::OrientationConstraintEvaluator::use | ( | const arm_navigation_msgs::OrientationConstraint & | pc | ) |
This function assumes the constraint has been transformed into the proper frame, if such a transform is needed.
Definition at line 191 of file kinematic_state_constraint_evaluator.cpp.
boost::scoped_ptr<bodies::Body> planning_environment::OrientationConstraintEvaluator::m_constraint_region [protected] |
Definition at line 149 of file kinematic_state_constraint_evaluator.h.
arm_navigation_msgs::OrientationConstraint planning_environment::OrientationConstraintEvaluator::m_oc [protected] |
Definition at line 146 of file kinematic_state_constraint_evaluator.h.
double planning_environment::OrientationConstraintEvaluator::m_pitch [protected] |
Definition at line 147 of file kinematic_state_constraint_evaluator.h.
double planning_environment::OrientationConstraintEvaluator::m_roll [protected] |
Definition at line 147 of file kinematic_state_constraint_evaluator.h.
Definition at line 148 of file kinematic_state_constraint_evaluator.h.
double planning_environment::OrientationConstraintEvaluator::m_yaw [protected] |
Definition at line 147 of file kinematic_state_constraint_evaluator.h.