使用 tf broadcast 发布位置

Question

我在使用 tf::TransformListener 和以下方法调用时遇到一点问题：

listener.lookupTransform("/base_footprint", "/odom", ros::Time(0), transform);

我收到这个错误：

[ERROR] [1430761593.614566598, 10.000000000]: "base_footprint" passed to lookupTransform argument target_frame does not exist.

我还以为是因为我没有用过tf broacaster，结果问题依旧。我做错了什么？

侦听器的代码：

tf::TransformListener listener;
ros::Rate rate(1.0);
listener.waitForTransform("/base_footprint", "/odom", ros::Time(0), ros::Duration(10.0));
tf::StampedTransform transform;
try 
{            
    listener.lookupTransform("/base_footprint", "/odom", ros::Time(0), transform);
    double x = transform.getOrigin().x();
    double y = transform.getOrigin().y();
    ROS_INFO("Current position: ( %f , %f)\n",x,y);
}
catch (tf::TransformException &ex)
{
    ROS_ERROR("%s",ex.what());
}

广播公司代码：

ros::Time current_time, last_time;
tf::TransformBroadcaster odom_broadcaster;

double x = 0.0;
double y = 0.0;
double th = 0.0;

double vx = 0.1;
double vy = -0.1;
double vth = 0.1;

current_time = ros::Time::now();
double dt = (current_time - last_time).toSec();
double delta_x = (vx * cos(th) - vy * sin(th)) * dt;
double delta_y = (vx * sin(th) + vy * cos(th)) * dt;
double delta_th = vth * dt;

x += delta_x;
y += delta_y;
th += delta_th; 

geometry_msgs::Quaternion odom_quat = tf::createQuaternionMsgFromYaw(th);

geometry_msgs::TransformStamped odom_trans;
odom_trans.header.stamp = current_time;
odom_trans.header.frame_id = "odom";
odom_trans.child_frame_id = "base_link";

odom_trans.transform.translation.x = x;
odom_trans.transform.translation.y = y;
odom_trans.transform.translation.z = 0.0;
odom_trans.transform.rotation = odom_quat;

//send the transform
odom_broadcaster.sendTransform(odom_trans);

last_time = current_time;

Answer 1

如果这是您正在使用的唯一 tf 发布者（例如没有 joint_state_publisher or other publishers), I suggest you to have a look at tf tutorials. Especially to this one: robot setup。

如您所见，here，lookupTransform(std::string &W, std::string &A, ros::Time &time, StampedTransform &transform) 存储在 transform 中的转换，将您从帧 A 引导到帧 W。

在您的示例中，您试图获得从 "/odom" 到 "/base_footprint" 的转换，而发布者正在广播 "/base_link" 和 "/odom" 之间的转换（即 "/base_footprint" 未指定）。使用相同的名称应该没问题（例如，如果 "/base_link" 或 "/base_footprint" 代表与我假设的相同的帧）。

此外，请注意，在您的发布商中，您正在广播从 "/base_link" 到 "/odom" 的转换而不是相反（如您所愿）。

编辑： 如果您为机器人使用 .urdf 模型，请将其添加到您的问题或 post tf 树中。

Answer 2

我建议运行在您的终端中执行下一个命令，以确保您的帧是正确的，并且它们正在被广播。当我们运行你的听众你应该能够以图形方式看到你 \base_footprint 转变为 \odom:

rosrun rqt_tf_tree rqt_tf_tree

使用 tf broadcast 发布位置

publishing location using tf broadcast

ros