ROS-TF库-写一个TransformBroadcaster发布

最新推荐文章于 2025-05-22 16:28:30 发布

明夷TEC

最新推荐文章于 2025-05-22 16:28:30 发布

阅读量4.7k

点赞数 3

CC 4.0 BY-SA版权

分类专栏： TF库文章标签：发布tf变换

本文链接：https://blog.csdn.net/qq_39534332/article/details/91145920

TF库专栏收录该内容

5 篇文章

订阅专栏

本文详细介绍了在ROS中如何使用TransformBroadcaster类发布坐标变换。通过实例代码演示了从订阅/turtle_pose话题获取数据，到创建并发布tf变换的全过程。文章适合ROS初学者及对tf变换感兴趣的开发者。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

1 TransformBroadcaster类

tf包提供了TransformBroadcaster类的实现，以帮助简化tf发布转换的任务。
要使用TransformBroadcaster，我们需要包含<tf/transform_Broadcaster.h>头文件。
如下是发布一个world-turtle1的一个坐标变换,来具体看TransformBroadcaster类的用法:

#include <ros/ros.h>
#include <tf/transform_broadcaster.h>
#include <turtlesim/Pose.h>
std::string turtle_name;

void poseCallback(const turtlesim::PoseConstPtr& msg){

  // 1. 创建一个tf发布对象
  static tf::TransformBroadcaster br;

  // 2. 创建一个tf对象
  tf::Transform transform;
　　
  // 3. 设置tf的平移旋转，（把小龟的２ｄ位姿复制到３ｄ变换）
  transform.setOrigin( tf::Vector3(msg->x, msg->y, 0.0) );
  tf::Quaternion q;
  q.setRPY(0, 0, msg->theta);
  transform.setRotation(q);

  // 4. 发布tf变换
  br.sendTransform(tf::StampedTransform(transform, ros::Time::now(), "world", turtle_name));
}

int main(int argc, char** argv){
  ros::init(argc, argv, "turtle_tf_broadcaster");
  if (argc != 2)
  {ROS_ERROR("need turtle name as argument"); return -1; };
  turtle_name = argv[1];
  ros::NodeHandle node;
  ros::Subscriber sub = node.subscribe(turtle_name+"/pose", 10, &poseCallback);
  ros::spin();
  return 0;
};