A joint from the robot. Models the transform that this joint applies in the kinematic chain. A joint consists of multiple variables. In the simplest case, when the joint is a single DOF, there is only one variable and its name is the same as the joint's name. For multi-DOF joints, each variable has a local name (e.g., x, y) but the full variable name as seen from the outside of this class is a concatenation of the "joint name"/"local name" (e.g., a joint named 'base' with local variables 'x' and 'y' will store its full variable names as 'base/x' and 'base/y'). Local names are never used to reference variables directly. More...
#include <joint_model.h>
Public Types | |
using | Bounds = std::vector< VariableBounds > |
The datatype for the joint bounds. More... | |
enum | JointType { UNKNOWN, REVOLUTE, PRISMATIC, PLANAR, FLOATING, FIXED } |
The different types of joints we support. More... | |
Public Member Functions | |
void | addDescendantJointModel (const JointModel *joint) |
void | addDescendantLinkModel (const LinkModel *link) |
void | addMimicRequest (const JointModel *joint) |
Notify this joint that there is another joint that mimics it. More... | |
virtual double | distance (const double *value1, const double *value2) const =0 |
Compute the distance between two joint states of the same model (represented by the variable values) More... | |
const LinkModel * | getChildLinkModel () const |
Get the link that this joint connects to. There will always be such a link. More... | |
const std::vector< const JointModel * > & | getDescendantJointModels () const |
Get all the joint models that descend from this joint, in the kinematic tree. More... | |
const std::vector< const LinkModel * > & | getDescendantLinkModels () const |
Get all the link models that descend from this joint, in the kinematic tree. More... | |
double | getDistanceFactor () const |
Get the factor that should be applied to the value returned by distance() when that value is used in compound distances. More... | |
double | getMaximumExtent () const |
virtual double | getMaximumExtent (const Bounds &other_bounds) const =0 |
Get the extent of the state space (the maximum value distance() can ever report) More... | |
const JointModel * | getMimic () const |
Get the joint this one is mimicking. More... | |
double | getMimicFactor () const |
If mimicking a joint, this is the multiplicative factor for that joint's value. More... | |
double | getMimicOffset () const |
If mimicking a joint, this is the offset added to that joint's value. More... | |
const std::vector< const JointModel * > & | getMimicRequests () const |
The joint models whose values would be modified if the value of this joint changed. More... | |
const std::string & | getName () const |
Get the name of the joint. More... | |
const std::vector< const JointModel * > & | getNonFixedDescendantJointModels () const |
Get all the non-fixed joint models that descend from this joint, in the kinematic tree. More... | |
const LinkModel * | getParentLinkModel () const |
Get the link that this joint connects to. The robot is assumed to start with a joint, so the root joint will return a NULL pointer here. More... | |
virtual unsigned int | getStateSpaceDimension () const =0 |
Get the dimension of the state space that corresponds to this joint. More... | |
JointType | getType () const |
Get the type of joint. More... | |
std::string | getTypeName () const |
Get the type of joint as a string. More... | |
virtual void | interpolate (const double *from, const double *to, const double t, double *state) const =0 |
Computes the state that lies at time t in [0, 1] on the segment that connects from state to to state. The memory location of state is not required to be different from the memory of either from or to. More... | |
bool | isPassive () const |
Check if this joint is passive. More... | |
JointModel (const std::string &name) | |
Construct a joint named name. More... | |
void | setChildLinkModel (const LinkModel *link) |
void | setDistanceFactor (double factor) |
Set the factor that should be applied to the value returned by distance() when that value is used in compound distances. More... | |
void | setMimic (const JointModel *mimic, double factor, double offset) |
Mark this joint as mimicking mimic using factor and offset. More... | |
void | setParentLinkModel (const LinkModel *link) |
void | setPassive (bool flag) |
virtual | ~JointModel () |
Reason about the variables that make up this joint | |
const std::vector< std::string > & | getVariableNames () const |
Get the names of the variables that make up this joint, in the order they appear in corresponding states. For single DOF joints, this will be just the joint name. For multi-DOF joints these will be the joint name followed by "/", followed by the local names of the variables. More... | |
const std::vector< std::string > & | getLocalVariableNames () const |
Get the local names of the variable that make up the joint (suffixes that are attached to joint names to construct the variable names). For single DOF joints, this will be empty. More... | |
bool | hasVariable (const std::string &variable) const |
Check if a particular variable is known to this joint. More... | |
std::size_t | getVariableCount () const |
Get the number of variables that describe this joint. More... | |
int | getFirstVariableIndex () const |
Get the index of this joint's first variable within the full robot state. More... | |
void | setFirstVariableIndex (int index) |
Set the index of this joint's first variable within the full robot state. More... | |
int | getJointIndex () const |
Get the index of this joint within the robot model. More... | |
void | setJointIndex (int index) |
Set the index of this joint within the robot model. More... | |
int | getLocalVariableIndex (const std::string &variable) const |
Get the index of the variable within this joint. More... | |
Functionality specific to computing state values | |
void | getVariableDefaultPositions (double *values) const |
Provide a default value for the joint given the default joint variable bounds (maintained internally). Most joints will use the default implementation provided in this base class, but the quaternion for example needs a different implementation. Enough memory is assumed to be allocated. More... | |
virtual void | getVariableDefaultPositions (double *values, const Bounds &other_bounds) const =0 |
Provide a default value for the joint given the joint variable bounds. Most joints will use the default implementation provided in this base class, but the quaternion for example needs a different implementation. Enough memory is assumed to be allocated. More... | |
void | getVariableRandomPositions (random_numbers::RandomNumberGenerator &rng, double *values) const |
Provide random values for the joint variables (within default bounds). Enough memory is assumed to be allocated. More... | |
virtual void | getVariableRandomPositions (random_numbers::RandomNumberGenerator &rng, double *values, const Bounds &other_bounds) const =0 |
Provide random values for the joint variables (within specified bounds). Enough memory is assumed to be allocated. More... | |
void | getVariableRandomPositionsNearBy (random_numbers::RandomNumberGenerator &rng, double *values, const double *seed, const double distance) const |
Provide random values for the joint variables (within default bounds). Enough memory is assumed to be allocated. More... | |
virtual void | getVariableRandomPositionsNearBy (random_numbers::RandomNumberGenerator &rng, double *values, const Bounds &other_bounds, const double *seed, const double distance) const =0 |
Provide random values for the joint variables (within specified bounds). Enough memory is assumed to be allocated. More... | |
Functionality specific to verifying bounds | |
bool | satisfiesPositionBounds (const double *values, double margin=0.0) const |
Check if the set of values for the variables of this joint are within bounds. More... | |
virtual bool | satisfiesPositionBounds (const double *values, const Bounds &other_bounds, double margin) const =0 |
Check if the set of position values for the variables of this joint are within bounds, up to some margin. More... | |
bool | enforcePositionBounds (double *values) const |
Force the specified values to be inside bounds and normalized. Quaternions are normalized, continuous joints are made between -Pi and Pi. Returns true if changes were made. More... | |
virtual bool | enforcePositionBounds (double *values, const Bounds &other_bounds) const =0 |
Force the specified values to be inside bounds and normalized. Quaternions are normalized, continuous joints are made between -Pi and Pi. Return true if changes were made. More... | |
virtual bool | harmonizePosition (double *values, const Bounds &other_bounds) const |
bool | harmonizePosition (double *values) const |
bool | satisfiesVelocityBounds (const double *values, double margin=0.0) const |
Check if the set of velocities for the variables of this joint are within bounds. More... | |
virtual bool | satisfiesVelocityBounds (const double *values, const Bounds &other_bounds, double margin) const |
Check if the set of velocities for the variables of this joint are within bounds, up to some margin. More... | |
bool | enforceVelocityBounds (double *values) const |
Force the specified velocities to be within bounds. Return true if changes were made. More... | |
virtual bool | enforceVelocityBounds (double *values, const Bounds &other_bounds) const |
Force the specified velocities to be inside bounds. Return true if changes were made. More... | |
bool | satisfiesAccelerationBounds (const double *values, double margin=0.0) const |
Check if the set of accelerations for the variables of this joint are within bounds. More... | |
virtual bool | satisfiesAccelerationBounds (const double *values, const Bounds &other_bounds, double margin) const |
Check if the set of accelerations for the variables of this joint are within bounds, up to some margin. More... | |
const VariableBounds & | getVariableBounds (const std::string &variable) const |
Get the bounds for a variable. Throw an exception if the variable was not found. More... | |
const Bounds & | getVariableBounds () const |
Get the variable bounds for this joint, in the same order as the names returned by getVariableNames() More... | |
void | setVariableBounds (const std::string &variable, const VariableBounds &bounds) |
Set the lower and upper bounds for a variable. Throw an exception if the variable was not found. More... | |
void | setVariableBounds (const std::vector< moveit_msgs::JointLimits > &jlim) |
Override joint limits loaded from URDF. Unknown variables are ignored. More... | |
const std::vector< moveit_msgs::JointLimits > & | getVariableBoundsMsg () const |
Get the joint limits known to this model, as a message. More... | |
Computing transforms | |
virtual void | computeTransform (const double *joint_values, Eigen::Isometry3d &transf) const =0 |
Given the joint values for a joint, compute the corresponding transform. The computed transform is guaranteed to be a valid isometry. More... | |
virtual void | computeVariablePositions (const Eigen::Isometry3d &transform, double *joint_values) const =0 |
Given the transform generated by joint, compute the corresponding joint values. Make sure the passed transform is a valid isometry. More... | |
Protected Member Functions | |
void | computeVariableBoundsMsg () |
Protected Attributes | |
const LinkModel * | child_link_model_ |
The link after this joint. More... | |
std::vector< const JointModel * > | descendant_joint_models_ |
Pointers to all the joints that follow this one in the kinematic tree (including mimic joints) More... | |
std::vector< const LinkModel * > | descendant_link_models_ |
Pointers to all the links that will be moved if this joint changes value. More... | |
double | distance_factor_ |
The factor applied to the distance between two joint states. More... | |
int | first_variable_index_ |
The index of this joint's first variable, in the complete robot state. More... | |
int | joint_index_ |
Index for this joint in the array of joints of the complete model. More... | |
std::vector< std::string > | local_variable_names_ |
The local names to use for the variables that make up this joint. More... | |
const JointModel * | mimic_ |
The joint this one mimics (NULL for joints that do not mimic) More... | |
double | mimic_factor_ |
The offset to the mimic joint. More... | |
double | mimic_offset_ |
The multiplier to the mimic joint. More... | |
std::vector< const JointModel * > | mimic_requests_ |
The set of joints that should get a value copied to them when this joint changes. More... | |
std::string | name_ |
Name of the joint. More... | |
std::vector< const JointModel * > | non_fixed_descendant_joint_models_ |
Pointers to all the joints that follow this one in the kinematic tree, including mimic joints, but excluding fixed joints. More... | |
const LinkModel * | parent_link_model_ |
The link before this joint. More... | |
bool | passive_ |
Specify whether this joint is marked as passive in the SRDF. More... | |
JointType | type_ |
The type of joint. More... | |
Bounds | variable_bounds_ |
The bounds for each variable (low, high) in the same order as variable_names_. More... | |
std::vector< moveit_msgs::JointLimits > | variable_bounds_msg_ |
VariableIndexMap | variable_index_map_ |
Map from variable names to the corresponding index in variable_names_ (indexing makes sense within the JointModel only) More... | |
std::vector< std::string > | variable_names_ |
The full names to use for the variables that make up this joint. More... | |
A joint from the robot. Models the transform that this joint applies in the kinematic chain. A joint consists of multiple variables. In the simplest case, when the joint is a single DOF, there is only one variable and its name is the same as the joint's name. For multi-DOF joints, each variable has a local name (e.g., x, y) but the full variable name as seen from the outside of this class is a concatenation of the "joint name"/"local name" (e.g., a joint named 'base' with local variables 'x' and 'y' will store its full variable names as 'base/x' and 'base/y'). Local names are never used to reference variables directly.
Definition at line 173 of file joint_model.h.
using moveit::core::JointModel::Bounds = std::vector<VariableBounds> |
The datatype for the joint bounds.
Definition at line 188 of file joint_model.h.
The different types of joints we support.
Enumerator | |
---|---|
UNKNOWN | |
REVOLUTE | |
PRISMATIC | |
PLANAR | |
FLOATING | |
FIXED |
Definition at line 177 of file joint_model.h.
moveit::core::JointModel::JointModel | ( | const std::string & | name | ) |
Construct a joint named name.
Definition at line 113 of file joint_model.cpp.
|
virtualdefault |
void moveit::core::JointModel::addDescendantJointModel | ( | const JointModel * | joint | ) |
Definition at line 284 of file joint_model.cpp.
void moveit::core::JointModel::addDescendantLinkModel | ( | const LinkModel * | link | ) |
Definition at line 291 of file joint_model.cpp.
void moveit::core::JointModel::addMimicRequest | ( | const JointModel * | joint | ) |
Notify this joint that there is another joint that mimics it.
Definition at line 279 of file joint_model.cpp.
|
pure virtual |
Given the joint values for a joint, compute the corresponding transform. The computed transform is guaranteed to be a valid isometry.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
protected |
Definition at line 253 of file joint_model.cpp.
|
pure virtual |
Given the transform generated by joint, compute the corresponding joint values. Make sure the passed transform is a valid isometry.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
pure virtual |
Compute the distance between two joint states of the same model (represented by the variable values)
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
inline |
Force the specified values to be inside bounds and normalized. Quaternions are normalized, continuous joints are made between -Pi and Pi. Returns true if changes were made.
Definition at line 355 of file joint_model.h.
|
pure virtual |
Force the specified values to be inside bounds and normalized. Quaternions are normalized, continuous joints are made between -Pi and Pi. Return true if changes were made.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
inline |
Force the specified velocities to be within bounds. Return true if changes were made.
Definition at line 383 of file joint_model.h.
|
virtual |
Force the specified velocities to be inside bounds. Return true if changes were made.
Definition at line 164 of file joint_model.cpp.
|
inline |
Get the link that this joint connects to. There will always be such a link.
Definition at line 219 of file joint_model.h.
|
inline |
Get all the joint models that descend from this joint, in the kinematic tree.
Definition at line 482 of file joint_model.h.
|
inline |
Get all the link models that descend from this joint, in the kinematic tree.
Definition at line 476 of file joint_model.h.
|
inline |
Get the factor that should be applied to the value returned by distance() when that value is used in compound distances.
Definition at line 428 of file joint_model.h.
|
inline |
Get the index of this joint's first variable within the full robot state.
Definition at line 267 of file joint_model.h.
|
inline |
Get the index of this joint within the robot model.
Definition at line 279 of file joint_model.h.
int moveit::core::JointModel::getLocalVariableIndex | ( | const std::string & | variable | ) | const |
Get the index of the variable within this joint.
Definition at line 151 of file joint_model.cpp.
|
inline |
Get the local names of the variable that make up the joint (suffixes that are attached to joint names to construct the variable names). For single DOF joints, this will be empty.
Definition at line 249 of file joint_model.h.
|
inline |
Definition at line 513 of file joint_model.h.
|
pure virtual |
Get the extent of the state space (the maximum value distance() can ever report)
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
inline |
Get the joint this one is mimicking.
Definition at line 444 of file joint_model.h.
|
inline |
If mimicking a joint, this is the multiplicative factor for that joint's value.
Definition at line 456 of file joint_model.h.
|
inline |
If mimicking a joint, this is the offset added to that joint's value.
Definition at line 450 of file joint_model.h.
|
inline |
The joint models whose values would be modified if the value of this joint changed.
Definition at line 465 of file joint_model.h.
|
inline |
Get the name of the joint.
Definition at line 196 of file joint_model.h.
|
inline |
Get all the non-fixed joint models that descend from this joint, in the kinematic tree.
Definition at line 488 of file joint_model.h.
|
inline |
Get the link that this joint connects to. The robot is assumed to start with a joint, so the root joint will return a NULL pointer here.
Definition at line 213 of file joint_model.h.
|
pure virtual |
Get the dimension of the state space that corresponds to this joint.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
inline |
Get the type of joint.
Definition at line 202 of file joint_model.h.
std::string moveit::core::JointModel::getTypeName | ( | ) | const |
Get the type of joint as a string.
Definition at line 130 of file joint_model.cpp.
|
inline |
Get the variable bounds for this joint, in the same order as the names returned by getVariableNames()
Definition at line 404 of file joint_model.h.
const VariableBounds & moveit::core::JointModel::getVariableBounds | ( | const std::string & | variable | ) | const |
Get the bounds for a variable. Throw an exception if the variable was not found.
Definition at line 213 of file joint_model.cpp.
|
inline |
Get the joint limits known to this model, as a message.
Definition at line 416 of file joint_model.h.
|
inline |
Get the number of variables that describe this joint.
Definition at line 261 of file joint_model.h.
|
inline |
Provide a default value for the joint given the default joint variable bounds (maintained internally). Most joints will use the default implementation provided in this base class, but the quaternion for example needs a different implementation. Enough memory is assumed to be allocated.
Definition at line 301 of file joint_model.h.
|
pure virtual |
Provide a default value for the joint given the joint variable bounds. Most joints will use the default implementation provided in this base class, but the quaternion for example needs a different implementation. Enough memory is assumed to be allocated.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
inline |
Get the names of the variables that make up this joint, in the order they appear in corresponding states. For single DOF joints, this will be just the joint name. For multi-DOF joints these will be the joint name followed by "/", followed by the local names of the variables.
Definition at line 241 of file joint_model.h.
|
inline |
Provide random values for the joint variables (within default bounds). Enough memory is assumed to be allocated.
Definition at line 313 of file joint_model.h.
|
pure virtual |
Provide random values for the joint variables (within specified bounds). Enough memory is assumed to be allocated.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
pure virtual |
Provide random values for the joint variables (within specified bounds). Enough memory is assumed to be allocated.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
inline |
Provide random values for the joint variables (within default bounds). Enough memory is assumed to be allocated.
Definition at line 325 of file joint_model.h.
|
inline |
Definition at line 368 of file joint_model.h.
|
virtual |
Harmonize position of revolute joints, adding/subtracting multiples of 2*Pi to bring them back into bounds. Return true if changes were made.
Reimplemented in moveit::core::RevoluteJointModel.
Definition at line 159 of file joint_model.cpp.
|
inline |
Check if a particular variable is known to this joint.
Definition at line 255 of file joint_model.h.
|
pure virtual |
Computes the state that lies at time t in [0, 1] on the segment that connects from state to to state. The memory location of state is not required to be different from the memory of either from or to.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
inline |
Check if this joint is passive.
Definition at line 494 of file joint_model.h.
|
virtual |
Check if the set of accelerations for the variables of this joint are within bounds, up to some margin.
Definition at line 197 of file joint_model.cpp.
|
inline |
Check if the set of accelerations for the variables of this joint are within bounds.
Definition at line 392 of file joint_model.h.
|
pure virtual |
Check if the set of position values for the variables of this joint are within bounds, up to some margin.
Implemented in moveit::core::PlanarJointModel, moveit::core::PrismaticJointModel, moveit::core::RevoluteJointModel, moveit::core::FixedJointModel, and moveit::core::FloatingJointModel.
|
inline |
Check if the set of values for the variables of this joint are within bounds.
Definition at line 343 of file joint_model.h.
|
virtual |
Check if the set of velocities for the variables of this joint are within bounds, up to some margin.
Definition at line 181 of file joint_model.cpp.
|
inline |
Check if the set of velocities for the variables of this joint are within bounds.
Definition at line 374 of file joint_model.h.
|
inline |
Definition at line 229 of file joint_model.h.
|
inline |
Set the factor that should be applied to the value returned by distance() when that value is used in compound distances.
Definition at line 435 of file joint_model.h.
|
inline |
Set the index of this joint's first variable within the full robot state.
Definition at line 273 of file joint_model.h.
|
inline |
Set the index of this joint within the robot model.
Definition at line 285 of file joint_model.h.
void moveit::core::JointModel::setMimic | ( | const JointModel * | mimic, |
double | factor, | ||
double | offset | ||
) |
Mark this joint as mimicking mimic using factor and offset.
Definition at line 272 of file joint_model.cpp.
|
inline |
Definition at line 224 of file joint_model.h.
|
inline |
Definition at line 499 of file joint_model.h.
void moveit::core::JointModel::setVariableBounds | ( | const std::string & | variable, |
const VariableBounds & | bounds | ||
) |
Set the lower and upper bounds for a variable. Throw an exception if the variable was not found.
Definition at line 218 of file joint_model.cpp.
void moveit::core::JointModel::setVariableBounds | ( | const std::vector< moveit_msgs::JointLimits > & | jlim | ) |
Override joint limits loaded from URDF. Unknown variables are ignored.
Definition at line 224 of file joint_model.cpp.
|
protected |
The link after this joint.
Definition at line 559 of file joint_model.h.
|
protected |
Pointers to all the joints that follow this one in the kinematic tree (including mimic joints)
Definition at line 577 of file joint_model.h.
|
protected |
Pointers to all the links that will be moved if this joint changes value.
Definition at line 574 of file joint_model.h.
|
protected |
The factor applied to the distance between two joint states.
Definition at line 587 of file joint_model.h.
|
protected |
The index of this joint's first variable, in the complete robot state.
Definition at line 590 of file joint_model.h.
|
protected |
Index for this joint in the array of joints of the complete model.
Definition at line 593 of file joint_model.h.
|
protected |
The local names to use for the variables that make up this joint.
Definition at line 541 of file joint_model.h.
|
protected |
The joint this one mimics (NULL for joints that do not mimic)
Definition at line 562 of file joint_model.h.
|
protected |
The offset to the mimic joint.
Definition at line 565 of file joint_model.h.
|
protected |
The multiplier to the mimic joint.
Definition at line 568 of file joint_model.h.
|
protected |
The set of joints that should get a value copied to them when this joint changes.
Definition at line 571 of file joint_model.h.
|
protected |
Name of the joint.
Definition at line 535 of file joint_model.h.
|
protected |
Pointers to all the joints that follow this one in the kinematic tree, including mimic joints, but excluding fixed joints.
Definition at line 581 of file joint_model.h.
|
protected |
The link before this joint.
Definition at line 556 of file joint_model.h.
|
protected |
Specify whether this joint is marked as passive in the SRDF.
Definition at line 584 of file joint_model.h.
|
protected |
The type of joint.
Definition at line 538 of file joint_model.h.
|
protected |
The bounds for each variable (low, high) in the same order as variable_names_.
Definition at line 547 of file joint_model.h.
|
protected |
Definition at line 549 of file joint_model.h.
|
protected |
Map from variable names to the corresponding index in variable_names_ (indexing makes sense within the JointModel only)
Definition at line 553 of file joint_model.h.
|
protected |
The full names to use for the variables that make up this joint.
Definition at line 544 of file joint_model.h.