本文整理汇总了C++中tf::Transformer::waitForTransform方法的典型用法代码示例。如果您正苦于以下问题:C++ Transformer::waitForTransform方法的具体用法?C++ Transformer::waitForTransform怎么用?C++ Transformer::waitForTransform使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类tf::Transformer
的用法示例。
在下文中一共展示了Transformer::waitForTransform方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: transformVectorTo
bool transformVectorTo(const tf::Transformer& tf, const string& source_frame, const string& goal_frame, const Time& time_source,
const geometry_msgs::Vector3& point_in, geometry_msgs::Vector3& point_out, const std::string& fixed_frame, const Time& time_goal)
{
ros::Duration timeout = Duration().fromSec(2.0);
if (!tf.waitForTransform(source_frame, time_source, goal_frame, time_goal, fixed_frame, timeout)) return false;
tf::Stamped<tf::Point> pnt(tf::Vector3(point_in.x, point_in.y, point_in.z), time_source, source_frame);
tf.transformVector(goal_frame, time_goal, pnt, fixed_frame, pnt);
point_out.x = pnt[0];
point_out.y = pnt[1];
point_out.z = pnt[2];
return true;
}