A Class which provides coordinate transforms between any two frames in a system. More...
#include <tf.h>
Public Member Functions | |
boost::signals2::connection | addTransformsChangedListener (boost::function< void(void)> callback) |
Add a callback that happens when a new transform has arrived. More... | |
std::string | allFramesAsDot (double current_time=0) const |
A way to see what frames have been cached Useful for debugging. More... | |
std::string | allFramesAsString () const |
A way to see what frames have been cached Useful for debugging. More... | |
bool | canTransform (const std::string &target_frame, const ros::Time &target_time, const std::string &source_frame, const ros::Time &source_time, const std::string &fixed_frame, std::string *error_msg=NULL) const |
Test if a transform is possible. More... | |
bool | canTransform (const std::string &target_frame, const std::string &source_frame, const ros::Time &time, std::string *error_msg=NULL) const |
Test if a transform is possible. More... | |
void | chainAsVector (const std::string &target_frame, ros::Time target_time, const std::string &source_frame, ros::Time source_time, const std::string &fixed_frame, std::vector< std::string > &output) const |
Debugging function that will print the spanning chain of transforms. Possible exceptions tf::LookupException, tf::ConnectivityException, tf::MaxDepthException. More... | |
void | clear () |
Clear all data. More... | |
bool | frameExists (const std::string &frame_id_str) const |
Check if a frame exists in the tree. More... | |
ros::Duration | getCacheLength () |
Get the duration over which this transformer will cache. More... | |
void | getFrameStrings (std::vector< std::string > &ids) const |
A way to get a std::vector of available frame ids. More... | |
int | getLatestCommonTime (const std::string &source_frame, const std::string &target_frame, ros::Time &time, std::string *error_string) const |
Return the latest rostime which is common across the spanning set zero if fails to cross. More... | |
bool | getParent (const std::string &frame_id, ros::Time time, std::string &parent) const |
Fill the parent of a frame. More... | |
std::shared_ptr< tf2_ros::Buffer > | getTF2BufferPtr () |
std::string | getTFPrefix () const |
Get the tf_prefix this is running with. More... | |
bool | isUsingDedicatedThread () |
void | lookupTransform (const std::string &target_frame, const ros::Time &target_time, const std::string &source_frame, const ros::Time &source_time, const std::string &fixed_frame, StampedTransform &transform) const |
Get the transform between two frames by frame ID assuming fixed frame. More... | |
void | lookupTransform (const std::string &target_frame, const std::string &source_frame, const ros::Time &time, StampedTransform &transform) const |
Get the transform between two frames by frame ID. More... | |
void | lookupTwist (const std::string &tracking_frame, const std::string &observation_frame, const ros::Time &time, const ros::Duration &averaging_interval, geometry_msgs::Twist &twist) const |
lookup the twist of the tracking frame with respect to the observational frame More... | |
void | lookupTwist (const std::string &tracking_frame, const std::string &observation_frame, const std::string &reference_frame, const tf::Point &reference_point, const std::string &reference_point_frame, const ros::Time &time, const ros::Duration &averaging_interval, geometry_msgs::Twist &twist) const |
Lookup the twist of the tracking_frame with respect to the observation frame in the reference_frame using the reference point. More... | |
void | removeTransformsChangedListener (boost::signals2::connection c) |
void | setExtrapolationLimit (const ros::Duration &distance) |
Set the distance which tf is allow to extrapolate. More... | |
bool | setTransform (const StampedTransform &transform, const std::string &authority="default_authority") |
Add transform information to the tf data structure. More... | |
void | setUsingDedicatedThread (bool value) |
Transformer (bool interpolating=true, ros::Duration cache_time_=ros::Duration(DEFAULT_CACHE_TIME)) | |
void | transformPoint (const std::string &target_frame, const ros::Time &target_time, const Stamped< tf::Point > &stamped_in, const std::string &fixed_frame, Stamped< tf::Point > &stamped_out) const |
Transform a Stamped Point into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument. More... | |
void | transformPoint (const std::string &target_frame, const Stamped< tf::Point > &stamped_in, Stamped< tf::Point > &stamped_out) const |
Transform a Stamped Point into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument. More... | |
void | transformPose (const std::string &target_frame, const ros::Time &target_time, const Stamped< tf::Pose > &stamped_in, const std::string &fixed_frame, Stamped< tf::Pose > &stamped_out) const |
Transform a Stamped Pose into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument. More... | |
void | transformPose (const std::string &target_frame, const Stamped< tf::Pose > &stamped_in, Stamped< tf::Pose > &stamped_out) const |
Transform a Stamped Pose into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument. More... | |
void | transformQuaternion (const std::string &target_frame, const ros::Time &target_time, const Stamped< tf::Quaternion > &stamped_in, const std::string &fixed_frame, Stamped< tf::Quaternion > &stamped_out) const |
Transform a Stamped Quaternion into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument. More... | |
void | transformQuaternion (const std::string &target_frame, const Stamped< tf::Quaternion > &stamped_in, Stamped< tf::Quaternion > &stamped_out) const |
Transform a Stamped Quaternion into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument. More... | |
void | transformVector (const std::string &target_frame, const ros::Time &target_time, const Stamped< tf::Vector3 > &stamped_in, const std::string &fixed_frame, Stamped< tf::Vector3 > &stamped_out) const |
Transform a Stamped Vector3 into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument. More... | |
void | transformVector (const std::string &target_frame, const Stamped< tf::Vector3 > &stamped_in, Stamped< tf::Vector3 > &stamped_out) const |
Transform a Stamped Vector3 into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument. More... | |
bool | waitForTransform (const std::string &target_frame, const ros::Time &target_time, const std::string &source_frame, const ros::Time &source_time, const std::string &fixed_frame, const ros::Duration &timeout, const ros::Duration &polling_sleep_duration=ros::Duration(0.01), std::string *error_msg=NULL) const |
Block until a transform is possible or it times out. More... | |
bool | waitForTransform (const std::string &target_frame, const std::string &source_frame, const ros::Time &time, const ros::Duration &timeout, const ros::Duration &polling_sleep_duration=ros::Duration(0.01), std::string *error_msg=NULL) const |
Block until a transform is possible or it times out. More... | |
virtual | ~Transformer (void) |
Public Attributes | |
bool | fall_back_to_wall_time_ |
Static Public Attributes | |
static const double | DEFAULT_CACHE_TIME = 10.0 |
10.0 is the default amount of time to cache data in seconds, set in cpp file. More... | |
static const int64_t | DEFAULT_MAX_EXTRAPOLATION_DISTANCE = 0ULL |
The default amount of time to extrapolate //deprecated since integration with tf2. More... | |
static const unsigned int | MAX_GRAPH_DEPTH = 100UL |
The maximum number of time to recurse before assuming the tree has a loop. More... | |
Protected Member Functions | |
ros::Time | now () const |
virtual bool | ok () const |
Protected Attributes | |
std::shared_ptr< tf2_ros::Buffer > | tf2_buffer_ptr_ |
std::string | tf_prefix_ |
The internal storage class for ReferenceTransform. More... | |
A Class which provides coordinate transforms between any two frames in a system.
This class provides a simple interface to allow recording and lookup of relationships between arbitrary frames of the system.
libTF assumes that there is a tree of coordinate frame transforms which define the relationship between all coordinate frames. For example your typical robot would have a transform from global to real world. And then from base to hand, and from base to head. But Base to Hand really is composed of base to shoulder to elbow to wrist to hand. libTF is designed to take care of all the intermediate steps for you.
Internal Representation libTF will store frames with the parameters necessary for generating the transform into that frame from it's parent and a reference to the parent frame. Frames are designated using an std::string 0 is a frame without a parent (the top of a tree) The positions of frames over time must be pushed in.
All function calls which pass frame ids can potentially throw the exception tf::LookupException
Transformer::Transformer | ( | bool | interpolating = true , |
ros::Duration | cache_time_ = ros::Duration(DEFAULT_CACHE_TIME) |
||
) |
boost::signals2::connection Transformer::addTransformsChangedListener | ( | boost::function< void(void)> | callback | ) |
std::string Transformer::allFramesAsDot | ( | double | current_time = 0 | ) | const |
std::string Transformer::allFramesAsString | ( | ) | const |
bool Transformer::canTransform | ( | const std::string & | target_frame, |
const ros::Time & | target_time, | ||
const std::string & | source_frame, | ||
const ros::Time & | source_time, | ||
const std::string & | fixed_frame, | ||
std::string * | error_msg = NULL |
||
) | const |
Test if a transform is possible.
target_frame | The frame into which to transform |
target_time | The time into which to transform |
source_frame | The frame from which to transform |
source_time | The time from which to transform |
fixed_frame | The frame in which to treat the transform as constant in time |
error_msg | A pointer to a string which will be filled with why the transform failed, if not NULL |
bool Transformer::canTransform | ( | const std::string & | target_frame, |
const std::string & | source_frame, | ||
const ros::Time & | time, | ||
std::string * | error_msg = NULL |
||
) | const |
Test if a transform is possible.
target_frame | The frame into which to transform |
source_frame | The frame from which to transform |
time | The time at which to transform |
error_msg | A pointer to a string which will be filled with why the transform failed, if not NULL |
void Transformer::chainAsVector | ( | const std::string & | target_frame, |
ros::Time | target_time, | ||
const std::string & | source_frame, | ||
ros::Time | source_time, | ||
const std::string & | fixed_frame, | ||
std::vector< std::string > & | output | ||
) | const |
Debugging function that will print the spanning chain of transforms. Possible exceptions tf::LookupException, tf::ConnectivityException, tf::MaxDepthException.
Debugging function that will print the spanning chain of transforms. Possible exceptions tf::LookupException, tf::ConnectivityException, tf::MaxDepthException
bool Transformer::frameExists | ( | const std::string & | frame_id_str | ) | const |
|
inline |
void Transformer::getFrameStrings | ( | std::vector< std::string > & | ids | ) | const |
int Transformer::getLatestCommonTime | ( | const std::string & | source_frame, |
const std::string & | target_frame, | ||
ros::Time & | time, | ||
std::string * | error_string | ||
) | const |
bool Transformer::getParent | ( | const std::string & | frame_id, |
ros::Time | time, | ||
std::string & | parent | ||
) | const |
|
inline |
|
inline |
void Transformer::lookupTransform | ( | const std::string & | target_frame, |
const ros::Time & | target_time, | ||
const std::string & | source_frame, | ||
const ros::Time & | source_time, | ||
const std::string & | fixed_frame, | ||
StampedTransform & | transform | ||
) | const |
Get the transform between two frames by frame ID assuming fixed frame.
target_frame | The frame to which data should be transformed |
target_time | The time to which the data should be transformed. (0 will get the latest) |
source_frame | The frame where the data originated |
source_time | The time at which the source_frame should be evaluated. (0 will get the latest) |
fixed_frame | The frame in which to assume the transform is constant in time. |
transform | The transform reference to fill. |
Possible exceptions tf::LookupException, tf::ConnectivityException, tf::MaxDepthException, tf::ExtrapolationException
void Transformer::lookupTransform | ( | const std::string & | target_frame, |
const std::string & | source_frame, | ||
const ros::Time & | time, | ||
StampedTransform & | transform | ||
) | const |
Get the transform between two frames by frame ID.
target_frame | The frame to which data should be transformed |
source_frame | The frame where the data originated |
time | The time at which the value of the transform is desired. (0 will get the latest) |
transform | The transform reference to fill. |
Possible exceptions tf::LookupException, tf::ConnectivityException, tf::MaxDepthException, tf::ExtrapolationException
void Transformer::lookupTwist | ( | const std::string & | tracking_frame, |
const std::string & | observation_frame, | ||
const ros::Time & | time, | ||
const ros::Duration & | averaging_interval, | ||
geometry_msgs::Twist & | twist | ||
) | const |
lookup the twist of the tracking frame with respect to the observational frame
This is a simplified version of lookupTwist with it assumed that the reference point is the origin of the tracking frame, and the reference frame is the observation frame.
New in geometry 1.1
void Transformer::lookupTwist | ( | const std::string & | tracking_frame, |
const std::string & | observation_frame, | ||
const std::string & | reference_frame, | ||
const tf::Point & | reference_point, | ||
const std::string & | reference_point_frame, | ||
const ros::Time & | time, | ||
const ros::Duration & | averaging_interval, | ||
geometry_msgs::Twist & | twist | ||
) | const |
Lookup the twist of the tracking_frame with respect to the observation frame in the reference_frame using the reference point.
tracking_frame | The frame to track |
observation_frame | The frame from which to measure the twist |
reference_frame | The reference frame in which to express the twist |
reference_point | The reference point with which to express the twist |
reference_point_frame | The frame_id in which the reference point is expressed |
time | The time at which to get the velocity |
duration | The period over which to average |
twist | The twist output |
This will compute the average velocity on the interval (time - duration/2, time+duration/2). If that is too close to the most recent reading, in which case it will shift the interval up to duration/2 to prevent extrapolation. Possible exceptions tf::LookupException, tf::ConnectivityException, tf::MaxDepthException, tf::ExtrapolationException
New in geometry 1.1
\TODO check time on reference point too
|
inlineprotected |
|
protectedvirtual |
Reimplemented in tf::TransformListener.
void Transformer::removeTransformsChangedListener | ( | boost::signals2::connection | c | ) |
void Transformer::setExtrapolationLimit | ( | const ros::Duration & | distance | ) |
bool Transformer::setTransform | ( | const StampedTransform & | transform, |
const std::string & | authority = "default_authority" |
||
) |
|
inline |
void Transformer::transformPoint | ( | const std::string & | target_frame, |
const ros::Time & | target_time, | ||
const Stamped< tf::Point > & | stamped_in, | ||
const std::string & | fixed_frame, | ||
Stamped< tf::Point > & | stamped_out | ||
) | const |
Transform a Stamped Point into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument.
void Transformer::transformPoint | ( | const std::string & | target_frame, |
const Stamped< tf::Point > & | stamped_in, | ||
Stamped< tf::Point > & | stamped_out | ||
) | const |
Transform a Stamped Point into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument.
void Transformer::transformPose | ( | const std::string & | target_frame, |
const ros::Time & | target_time, | ||
const Stamped< tf::Pose > & | stamped_in, | ||
const std::string & | fixed_frame, | ||
Stamped< tf::Pose > & | stamped_out | ||
) | const |
Transform a Stamped Pose into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument.
void Transformer::transformPose | ( | const std::string & | target_frame, |
const Stamped< tf::Pose > & | stamped_in, | ||
Stamped< tf::Pose > & | stamped_out | ||
) | const |
Transform a Stamped Pose into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument.
void Transformer::transformQuaternion | ( | const std::string & | target_frame, |
const ros::Time & | target_time, | ||
const Stamped< tf::Quaternion > & | stamped_in, | ||
const std::string & | fixed_frame, | ||
Stamped< tf::Quaternion > & | stamped_out | ||
) | const |
Transform a Stamped Quaternion into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument.
void Transformer::transformQuaternion | ( | const std::string & | target_frame, |
const Stamped< tf::Quaternion > & | stamped_in, | ||
Stamped< tf::Quaternion > & | stamped_out | ||
) | const |
Transform a Stamped Quaternion into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument.
void tf::Transformer::transformVector | ( | const std::string & | target_frame, |
const ros::Time & | target_time, | ||
const Stamped< tf::Vector3 > & | stamped_in, | ||
const std::string & | fixed_frame, | ||
Stamped< tf::Vector3 > & | stamped_out | ||
) | const |
Transform a Stamped Vector3 into the target frame This can throw anything a lookupTransform can throw as well as tf::InvalidArgument.
bool Transformer::waitForTransform | ( | const std::string & | target_frame, |
const ros::Time & | target_time, | ||
const std::string & | source_frame, | ||
const ros::Time & | source_time, | ||
const std::string & | fixed_frame, | ||
const ros::Duration & | timeout, | ||
const ros::Duration & | polling_sleep_duration = ros::Duration(0.01) , |
||
std::string * | error_msg = NULL |
||
) | const |
Block until a transform is possible or it times out.
target_frame | The frame into which to transform |
target_time | The time into which to transform |
source_frame | The frame from which to transform |
source_time | The time from which to transform |
fixed_frame | The frame in which to treat the transform as constant in time |
timeout | How long to block before failing |
polling_sleep_duration | How often to retest if failed |
error_msg | A pointer to a string which will be filled with why the transform failed, if not NULL |
bool Transformer::waitForTransform | ( | const std::string & | target_frame, |
const std::string & | source_frame, | ||
const ros::Time & | time, | ||
const ros::Duration & | timeout, | ||
const ros::Duration & | polling_sleep_duration = ros::Duration(0.01) , |
||
std::string * | error_msg = NULL |
||
) | const |
Block until a transform is possible or it times out.
target_frame | The frame into which to transform |
source_frame | The frame from which to transform |
time | The time at which to transform |
timeout | How long to block before failing |
polling_sleep_duration | How often to retest if failed |
error_msg | A pointer to a string which will be filled with why the transform failed, if not NULL |
|
static |
|
static |
|
static |
|
protected |
|
protected |
The internal storage class for ReferenceTransform.
An instance of this class is created for each frame in the system. This class natively handles the relationship between frames.
The derived class Pose3DCache provides a buffered history of positions with interpolation. transform prefix to apply as necessary