（21）ROS学习-TF坐标变换实例

最新推荐文章于 2024-03-26 23:39:05 发布
最新推荐文章于 2024-03-26 23:39:05 发布
阅读量390 收藏 3
点赞数 1
文章标签： 学习
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/weixin_52734156/article/details/128164930
版权

1.实现:

程序启动之初: 产生两只乌龟，中间的乌龟(A) 和 左下乌龟(B), B 会自动运行至A的位置，并且键盘控制时，只是控制 A 的运动，但是 B 可以跟随 A 运行

2.实现分析:

乌龟跟随实现的核心，是乌龟A和B都要发布相对世界坐标系的坐标信息，然后，订阅到该信息需要转换获取A相对于B坐标系的信息，最后，再生成速度信息，并控制B运动。

  1. 启动乌龟显示节点
  2. 在乌龟显示窗体中生成一只新的乌龟(需要使用服务)
  3. 编写两只乌龟发布坐标信息的节点
  4. 编写订阅节点订阅坐标信息并生成新的相对关系生成速度信息

实现流程（c++）:

  1. 新建功能包，添加依赖

  2. 编写服务客户端，用于生成一只新的乌龟

  3. 编写发布方，发布两只乌龟的坐标信息

  4. 编写订阅方，订阅两只乌龟信息，生成速度信息并发布

  5. 运行

3.创建项目功能包依赖于 tf2、tf2_ros、tf2_geometry_msgs、roscpp rospy std_msgs geometry_msgs、turtlesim，创包参考过往文章，每个功能文件的配置文件也参考过往文件。

3.1生成第二只乌龟：

 

/* 
    创建第二只小乌龟
 */
#include "ros/ros.h"
#include "turtlesim/Spawn.h"

int main(int argc, char *argv[])
{

    setlocale(LC_ALL,"");

    //执行初始化
    ros::init(argc,argv,"create_turtle");
    //创建节点
    ros::NodeHandle nh;
    //创建服务客户端
    ros::ServiceClient client = nh.serviceClient<turtlesim::Spawn>("/spawn");

    ros::service::waitForService("/spawn");
    turtlesim::Spawn spawn;
    spawn.request.name = "turtle2";
    spawn.request.x = 1.0;
    spawn.request.y = 2.0;
    spawn.request.theta = 3.12415926;
    bool flag = client.call(spawn);
    if (flag)
    {
        ROS_INFO("乌龟%s创建成功!",spawn.response.name.c_str());
    }
    else
    {
        ROS_INFO("乌龟2创建失败!");
    }

    ros::spin();

    return 0;
}

<launch>
    <!-- 启动乌龟节点与键盘控制节点 -->
    <node pkg="turtlesim" type="turtlesim_node" name="turtle1" output="screen" />
    <node pkg="turtlesim" type="turtle_teleop_key" name="key_control" output="screen"/>
    <!-- 启动创建第二只乌龟的节点 -->
    <node pkg="demo_tf2_test" type="Test01_Create_Turtle2" name="turtle2" output="screen" />


</launch>

 生成第二个乌龟并能用键盘控制第一个乌龟。

3.2发布方(发布两只乌龟的坐标信息)

可以订阅乌龟的位姿信息，然后再转换成坐标信息，两只乌龟的实现逻辑相同，只是订阅的话题名称，生成的坐标信息等稍有差异，可以将差异部分通过参数传入:

  • 该节点需要启动两次
  • 每次启动时都需要传入乌龟节点名称(第一次是 turtle1 第二次是 turtle2)
/*  
    该文件实现:需要订阅 turtle1 和 turtle2 的 pose，然后广播相对 world 的坐标系信息

    注意: 订阅的两只 turtle,除了命名空间(turtle1 和 turtle2)不同外,
          其他的话题名称和实现逻辑都是一样的，
          所以我们可以将所需的命名空间通过 args 动态传入

    实现流程:
        1.包含头文件
        2.初始化 ros 节点
        3.解析传入的命名空间
        4.创建 ros 句柄
        5.创建订阅对象
        6.回调函数处理订阅的 pose 信息
            6-1.创建 TF 广播器
            6-2.将 pose 信息转换成 TransFormStamped
            6-3.发布
        7.spin

*/
//1.包含头文件
#include "ros/ros.h"
#include "turtlesim/Pose.h"
#include "tf2_ros/transform_broadcaster.h"
#include "tf2/LinearMath/Quaternion.h"
#include "geometry_msgs/TransformStamped.h"
//保存乌龟名称
std::string turtle_name;


void doPose(const turtlesim::Pose::ConstPtr& pose){
    //  6-1.创建 TF 广播器 ---------------------------------------- 注意 static
    static tf2_ros::TransformBroadcaster broadcaster;
    //  6-2.将 pose 信息转换成 TransFormStamped
    geometry_msgs::TransformStamped tfs;
    tfs.header.frame_id = "world";
    tfs.header.stamp = ros::Time::now();
    tfs.child_frame_id = turtle_name;
    tfs.transform.translation.x = pose->x;
    tfs.transform.translation.y = pose->y;
    tfs.transform.translation.z = 0.0;
    tf2::Quaternion qtn;
    qtn.setRPY(0,0,pose->theta);
    tfs.transform.rotation.x = qtn.getX();
    tfs.transform.rotation.y = qtn.getY();
    tfs.transform.rotation.z = qtn.getZ();
    tfs.transform.rotation.w = qtn.getW();
    //  6-3.发布
    broadcaster.sendTransform(tfs);

} 

int main(int argc, char *argv[])
{
    setlocale(LC_ALL,"");
    // 2.初始化 ros 节点
    ros::init(argc,argv,"pub_tf");
    // 3.解析传入的命名空间
    if (argc != 2)
    {
        ROS_ERROR("请传入正确的参数");
    } else {
        turtle_name = argv[1];
        ROS_INFO("乌龟 %s 坐标发送启动",turtle_name.c_str());
    }

    // 4.创建 ros 句柄
    ros::NodeHandle nh;
    // 5.创建订阅对象
    ros::Subscriber sub = nh.subscribe<turtlesim::Pose>(turtle_name + "/pose",1000,doPose);
    //     6.回调函数处理订阅的 pose 信息
    //         6-1.创建 TF 广播器
    //         6-2.将 pose 信息转换成 TransFormStamped
    //         6-3.发布
    // 7.spin
    ros::spin();
    return 0;
}

<launch>
    <!-- 启动乌龟节点与键盘控制节点 -->
    <node pkg="turtlesim" type="turtlesim_node" name="turtle1" output="screen" />
    <node pkg="turtlesim" type="turtle_teleop_key" name="key_control" output="screen"/>
    <!-- 启动创建第二只乌龟的节点 -->
    <node pkg="demo_tf2_test" type="Test01_Create_Turtle2" name="turtle2" output="screen" />
    <!-- 启动两个坐标发布节点 -->
    <node pkg="demo_tf2_test" type="Test02_TF2_Caster" name="caster1" output="screen" args="turtle1" />
    <node pkg="demo_tf2_test" type="Test02_TF2_Caster" name="caster2" output="screen" args="turtle2" />
</launch>

3.3订阅方(解析坐标信息并生成速度信息)

/*  
    订阅 turtle1 和 turtle2 的 TF 广播信息，查找并转换时间最近的 TF 信息
    将 turtle1 转换成相对 turtle2 的坐标，在计算线速度和角速度并发布

    实现流程:
        1.包含头文件
        2.初始化 ros 节点
        3.创建 ros 句柄
        4.创建 TF 订阅对象
        5.处理订阅到的 TF
        6.spin

*/
//1.包含头文件
#include "ros/ros.h"
#include "tf2_ros/transform_listener.h"
#include "geometry_msgs/TransformStamped.h"
#include "geometry_msgs/Twist.h"

int main(int argc, char *argv[])
{
    setlocale(LC_ALL,"");
    // 2.初始化 ros 节点
    ros::init(argc,argv,"sub_TF");
    // 3.创建 ros 句柄
    ros::NodeHandle nh;
    // 4.创建 TF 订阅对象
    tf2_ros::Buffer buffer;
    tf2_ros::TransformListener listener(buffer);
    // 5.处理订阅到的 TF

    // 需要创建发布 /turtle2/cmd_vel 的 publisher 对象

    ros::Publisher pub = nh.advertise<geometry_msgs::Twist>("/turtle2/cmd_vel",1000);

    ros::Rate rate(10);
    while (ros::ok())
    {
        try
        {
            //5-1.先获取 turtle1 相对 turtle2 的坐标信息
            geometry_msgs::TransformStamped tfs = buffer.lookupTransform("turtle2","turtle1",ros::Time(0));

            //5-2.根据坐标信息生成速度信息 -- geometry_msgs/Twist.h
            geometry_msgs::Twist twist;
            twist.linear.x = 0.5 * sqrt(pow(tfs.transform.translation.x,2) + pow(tfs.transform.translation.y,2));
            twist.angular.z = 4 * atan2(tfs.transform.translation.y,tfs.transform.translation.x);

            //5-3.发布速度信息 -- 需要提前创建 publish 对象
            pub.publish(twist);
        }
        catch(const std::exception& e)
        {
            // std::cerr << e.what() << '\n';
            ROS_INFO("错误提示:%s",e.what());
        }



        rate.sleep();
        // 6.spin
        ros::spinOnce();
    }

    return 0;
}

<!--
    tf2 实现小乌龟跟随案例
-->
<launch>
    <!-- 启动乌龟节点与键盘控制节点 -->
    <node pkg="turtlesim" type="turtlesim_node" name="turtle1" output="screen" />
    <node pkg="turtlesim" type="turtle_teleop_key" name="key_control" output="screen"/>
    <!-- 启动创建第二只乌龟的节点 -->
    <node pkg="demo_tf2_test" type="Test01_Create_Turtle2" name="turtle2" output="screen" />
    <!-- 启动两个坐标发布节点 -->
    <node pkg="demo_tf2_test" type="Test02_TF2_Caster" name="caster1" output="screen" args="turtle1" />
    <node pkg="demo_tf2_test" type="Test02_TF2_Caster" name="caster2" output="screen" args="turtle2" />
    <!-- 启动坐标转换节点 -->
    <node pkg="demo_tf2_test" type="Test03_TF2_Listener" name="listener" output="screen" />
</launch>

 

月夜生云
关注
  • 1
    点赞
  • 踩
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
【ROS】中级操作学习整理-TF坐标变换
qq_52785580的博客
05-09 4171
本文介绍了TF坐标变换的基本概念以及TF在ROS中的表示形式（TF树），通过古月居的乌龟跟随的例子，分析了TF树的广播器和监听器最基本的书写形式，从中展示了如何提取和应用TF变换的信息，并介绍了5种最常用的TF树及TF信息的提取工具，最后简要说明了SLAM中最为重要的两种TF坐标变换。
5.1.6 TF坐标变换实操
赵虚左
03-23 747
ROS入门 5.1.6 TF坐标变换实操 《ROS入门-理论与实践》视频教程镇楼 需求描述: 程序启动之初: 产生两只乌龟，中间的乌龟(A) 和 左下乌龟(B), B 会自动运行至A的位置，并且键盘控制时，只是控制 A 的运动，但是 B 可以跟随 A 运行 结果演示: 实现分析: 乌龟跟随实现的核心，是乌龟A和B都要发布相对世界坐标系的坐标信息，然后，订阅到该信息需要转换获取A相对于B坐标系的信息，最后，再生成速度信息，并控制B运动。 启动乌龟显示节点 在乌龟显示窗体中生成一只新的乌龟(需要使用服
ROS学习（十四）--TF坐标变换
2201_75563228的博客
03-26 1428
TF（Transform）坐标变换是一种在机器人学和计算机视觉领域常用的技术，用于在不同坐标系之间进行转换和变换操作。TF是ROS（Robot Operating System）中的一个模块，提供了强大的坐标变换功能。在TF中，坐标变换是通过维护一个坐标变换树（Coordinate Frame Tree）来实现的。坐标变换树是由多个坐标系组成的层次结构，每个坐标系都有一个唯一的名称，称为Frame ID。树的根节点是一个固定的全局参考坐标系，通常称为"world"或"map"
ROS中的坐标与坐标系转换
张飞飞的博客
10-04 5553
ROS中的TF 官网建议新工作直接使用tf2，因为它有一个更清洁的界面，和更好的使用体验。（自ROS Hydro以来，tf第一代已被“弃用”，转而支持tf2） TF介绍 TF(TransForm)，就是坐标转换，包括了位置和姿态两个方面的变换。注意区分坐标转换和坐标系转换。 坐标转换是一个坐标在不同坐标系下的表示，而坐标系转换不同坐标系的相对位姿关系。 ROS中机器人模型包含大量的部件，每一个部件统称之为link（比如手部、头部、某个关节、某个连杆）,每一个link上面对应着一个frame（坐标系）, 用f
第 5 章 ROS 常用组件 1 —— TF 坐标变换_静态坐标变换 tf01_static / 动态坐标变换 tf02_dynamic
qq_42731062的博客
10-06 2404
静态和动态坐标
ROS——TF坐标变换
LYY_WJL的博客
09-12 1052
ROS——tf坐标系广播器与监听器编程实现
ROS学习-tf学习-简单例程代码
04-20
ROS-tf学习的简单例程代码，具体教程见：https://blog.csdn.net/qq_39779233/article/details/105638335
ros2-web-bridge:将浏览器桥接到ROS 2.0
04-27
ros2-web-bridgerosbridge v2协议的服务器实现ros2-web-bridge利用客户端，通过采用为提供JSON接口。 该网桥可以通过WebSockets上的JSON处理命令。ROS 2支持该ros2幅桥默认支持（目前最新的ROS 2的稳定版本 ），请...
ros-melodic-rosbridge-server:ros-melodic-rosbridge-serverAUR软件包
03-22
ros-melodic-rosbridge-server:ros-melodic-rosbridge-serverAUR软件包
ros2-21-tutorials
最新发布
05-09
学习ros2的21天教程，欢迎来看来学习，跟着我学习准没有错的，学习是我的快乐学习ros2的21天教程，欢迎来看来学习，跟着我学习准没有错的，学习是我的快乐学习ros2的21天教程，欢迎来看来学习，跟着我学习准没有错的...
ros-melodic-desktop_full.20201012.0.0.2010230001.nupkg
04-03
这个包适用于 在win10上安装ROS系统（melodic版本），在使用chocolatey下载安装ros的时候，速度奇慢。可下载这个包替换。路径：C:\opt\chocolatey\lib\ros-melodic-desktop_full\ros-melodic-desktop_full.nupkg
ROS-9 ROS常用组件之TF坐标变换
m0_46093829的博客
01-03 1305
一、概念 坐标变换简单来说就是归一化，即把测得的其他物体和机器人身上传感器之间的位置信息都换为物体和机器人的原点之间的信息。 根据我们高中学习的知识，只要明确了不同坐标系之间的的相对关系，就可以实现任何坐标点在不同坐标系之间的转换，但是该计算实现是较为常用的，且算法也有点复杂，因此在 ROS 中直接封装了相关的模块: 坐标变换(TF)。TF坐标变换用于在ROS中实现不同坐标系之间的点或向量的转换。 TF坐标变换通过广播TF变换和监听TF变换来实现的 二、查看系统中当前各个坐标系是否连通 ro
ROS学习笔记9：TF坐标变换实操
S13352784013的博客
01-30 873
本人ROS小白，利用寒假时间学习ROS，在此以笔记的方式记录自己每天的学习过程。争取写满20篇(9/20)。：严格按照下方学习链接的教程配置，基本一次成功。笔记绝大部分代码使用编写。：乌龟跟随。
ros入门（八）---TF坐标转换
weixin_51157015的博客
07-07 2473
TF(TransForm)，就是坐标转换，包括了位置和姿态两个方面的变换。
ROS中的TF坐标变换工具及实现、Rviz查看（十四）C++、python
weixin_50920579的博客
04-07 6034
1.Ubuntu中键盘失灵重启即可，不用重装键盘插件 2.只要配置好的CMakeLists代码文件编译过，就不会#include显示includepath有问题 因为编译后，相关导入库的路径才会更新到编译库里 3.在tf中，实际上是把收听到的广播信息存到buffer中，再调用buffer的API进行计算
[ROS 系列学习教程] ROS TF坐标变换 - 动态坐标变换
淋曦的进击手记
01-01 2279
所谓动态坐标变换，是指两个坐标系之间的相对位置是变化的。比如机械臂末端执行器与 base_link 之间，移动机器人base_link与world之间。可以理解动态坐标关系是随时间变化的静态坐标关系（即静态是动态对时间的微分）。订阅动态坐标转换关系，并利用该关系将小乌龟坐标系下的坐标转换到。目录，在这里存储脚本（如python脚本），我们创建。可以看到转换后的坐标，以及所属父坐标系。以及转换后的坐标都在同步动态变化。发布它相对世界坐标系的坐标。按钮，在弹出的窗口中选择。目录的同级，创建一个。
【ROS进阶篇】第五讲 ROS中的TF坐标变换
lc1852109的博客
06-30 896
本文主要介绍了TF2功能包的使用方法，从概念、作用出发，辅助上对于静态坐标变换、动态坐标变换、多坐标变换等编程及结果演示。
ROS之tf空间坐标变换完全详解
热门推荐
zhanghm1995的博客
11-30 3万+
本博文主要汇总了自己在使用ROS中tf坐标变换包时查找的一些参考资料和博客，包括了tf和部分tf2的使用，在此感谢所有博客中出现的博客链接！ 参考资源： ROS官网详细介绍： http://wiki.ros.org/tf/Tutorials http://wiki.ros.org/tf introduction to tf: http://wiki.ros.org/tf/Tutorials/Int...
ROS学习 TF坐标变换
weixin_43928944的博客
02-10 901
TF变换 已知小车base_link中心点(0,0,0) 激光雷达base_laser相对base_link位置,求激光雷达检测到的物体相对于小车中心点位置 ROS中的坐标描述 TF 静态坐标变换 rosrun tf2_ros static_transform_publisher x偏移量 y偏移量 z偏移量 z偏航角度 y俯仰角度 x翻滚角度 父级坐标 子级坐标 机器人的base_link 与其所有传感器坐标相对关系适合用TF静态坐标变换描述并放置在launch中。 rosrun tf2_ros st
ROS-TF-新建坐标系
05-24
在ROS中，我们可以使用TF库来管理坐标系之间的关系。要创建一个新的坐标系，需要执行以下步骤： 1. 在ROS包中创建一个新的launch文件，或者修改现有的launch文件。 2. 在launch文件中添加一个tf节点，指定新坐标系的父坐标系和子坐标系的名称，例如： ``` <node pkg="tf" type="static_transform_publisher" name="my_tf_publisher" args="x y z yaw pitch roll parent_frame child_frame period_in_ms"/> ``` 其中，x、y、z、yaw、pitch、roll分别表示新坐标系相对于父坐标系的平移和旋转，parent_frame和child_frame分别表示父坐标系和子坐标系的名称，period_in_ms表示tf更新的周期，单位为毫秒。 3. 启动ROS节点，运行launch文件。 4. 在RViz中查看坐标系之间的关系。 注意，需要确保新坐标系的名称与其他坐标系的名称不冲突。如果新坐标系的名称与现有坐标系的名称相同，可能会导致坐标系之间的关系出现问题。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值