9.ROS的TF坐标变换（三）：坐标系关系查看与一个案例

最新推荐文章于 2024-03-26 23:39:05 发布
最新推荐文章于 2024-03-26 23:39:05 发布
阅读量1.4k 收藏 21
点赞数 16
分类专栏： 如何用ORBSLAM3进行稠密建图用于路径规划 文章标签： 人工智能 机器人 计算机视觉 自动驾驶 算法
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_41694024/article/details/134752744
版权

1 查看目前的坐标系变化

        我们先安装功能包：

sudo apt install ros-melodic-tf2-tools

        安装成功！

        我们先启动上次的发布坐标变换的节点：

liuhongwei@liuhongwei-Legion-Y9000P-IRX8H:~/Desktop/final/my_catkin$ source devel/setup.bash 
liuhongwei@liuhongwei-Legion-Y9000P-IRX8H:~/Desktop/final/my_catkin$ roslaunch test tf_son1_son2.launch 
<launch>
    <node pkg="tf2_ros" type="static_transform_publisher" name="son1" args="0.2 0.8 0.3 0 0 0 /world /son1" output="screen" />
    <node pkg="tf2_ros" type="static_transform_publisher" name="son2" args="0.5 0 0 0 0 0 /world /son2" output="screen" />
</launch>

        目前坐标系的关系已经发布了。

        我们查看现在的坐标关系：       

rosrun tf2_tools view_frames.py
liuhongwei@liuhongwei-Legion-Y9000P-IRX8H:~$ rosrun tf2_tools view_frames.py
[INFO] [1701501936.157621]: Listening to tf data during 5 seconds...
[INFO] [1701501941.163282]: Generating graph in frames.pdf file...
liuhongwei@liuhongwei-Legion-Y9000P-IRX8H:~$

        生成了一个pdf文件。

        我们查看一下。      

2 案例：产生两只乌龟并让一只跟随另一只

2.1 需求

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

2.2 实现分析

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

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

实现流程:

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

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

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

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

  5. 运行

2.3 实现

2.3.1 实现1--启动乌龟1，生成乌龟2：GUI

        建立gen_turtle.cpp创建第二只乌龟：

//
// Created by liuhongwei on 23-12-2.
//
/*
    创建第二只小乌龟
 */
#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文件中：

<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="test" type="generate_turtle" name="turtle2" output="screen" />

</launch>

        启动节点：roslaunch test generate_turtle.launch

        功能全部实现！

        那么如何控制第二只乌龟运动呢？大家想一下怎么做！

2.3.2 发布乌龟坐标系相关关系

        发布两只乌龟相对于世界坐标系之间的关系：

        和前面基本一样，这里我们复用了前面的代码：

1.TF2与TF比较_简介

  • TF2已经替换了TF，TF2是TF的超集，建议学习 TF2 而非 TF

  • TF2 功能包的增强了内聚性，TF 与 TF2 所依赖的功能包是不同的，TF 对应的是tf包，TF2 对应的是tf2和tf2_ros包，在 TF2 中不同类型的 API 实现做了分包处理。

  • TF2 实现效率更高，比如在:TF2 的静态坐标实现、TF2 坐标变换监听器中的 Buffer 实现等

2.TF2与TF比较_静态坐标变换演示

接下来，我们通过静态坐标变换来演示TF2的实现效率。

2.1启动 TF2 与 TF 两个版本的静态坐标变换

TF2 版静态坐标变换:rosrun tf2_ros static_transform_publisher 0 0 0 0 0 0 /base_link /laser

TF 版静态坐标变换:rosrun tf static_transform_publisher 0 0 0 0 0 0 /base_link /laser 100

会发现，TF 版本的启动中最后多一个参数，该参数是指定发布频率

2.2运行结果比对

使用rostopic查看话题，包含/tf与/tf_static, 前者是 TF 发布的话题，后者是 TF2 发布的话题，分别调用命令打印二者的话题消息

rostopic echo /tf: 当前会循环输出坐标系信息

rostopic echo /tf_static: 坐标系信息只有一次

2.3结论

如果是静态坐标转换，那么不同坐标系之间的相对状态是固定的，既然是固定的，那么没有必要重复发布坐标系的转换消息，很显然的，tf2 实现较之于 tf 更为高效

        我们把它写入launch文件。

<!--
    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="test" type="generate_turtle" name="turtle2" output="screen" />
    <!-- 启动两个坐标发布节点 -->
    <node pkg="test" type="generate_turtle_locate" name="caster1" output="screen" args="turtle1" />
    <node pkg="test" type="generate_turtle_locate" name="caster2" output="screen" args="turtle2" />

</launch>

        启动launch文件：roslaunch test generate_turtle.launch

        我们打开RVIZ可视化一下：

2.3.3 订阅坐标信息并生成速度信息

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

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

        先来看t1怎么到t2：

        他们的直线距离为\sqrt{x^2+y^2}，角度为atan(y,x)，我们乘以一个参数就是速度、角速度。

            //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);

        因此我们得到了角速度、线速度并发布。

//
// Created by liuhongwei on 23-12-2.
//
/*
    订阅 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;
}

        我们执行launch文件。

        可以的。

3 小结

        坐标变换在机器人系统中是一个极其重要的组成模块，在 ROS 中 TF2 组件是专门用于实现坐标变换的，TF2 实现具体内容又主要介绍了如下几部分:

1.静态坐标变换广播器，可以编码方式或调用内置功能包来实现(建议后者)，适用于相对固定的坐标系关系

2.动态坐标变换广播器，以编码的方式广播坐标系之间的相对关系，适用于易变的坐标系关系

3.坐标变换监听器，用于监听广播器广播的坐标系消息，可以实现不同坐标系之间或同一点在不同坐标系之间的变换

4.机器人系统中的坐标系关系是较为复杂的，还可以通过 tf2_tools 工具包来生成 ros 中的坐标系关系图

5.当前 TF2 已经替换了 TF，官网建议直接学习 TF2，并且 TF 与 TF2 的使用流程与实现 API 比较类似，只要有任意一方的使用经验，另一方也可以做到触类旁通。

1.TF2与TF比较_简介

  • TF2已经替换了TF，TF2是TF的超集，建议学习 TF2 而非 TF

  • TF2 功能包的增强了内聚性，TF 与 TF2 所依赖的功能包是不同的，TF 对应的是tf包，TF2 对应的是tf2和tf2_ros包，在 TF2 中不同类型的 API 实现做了分包处理。

  • TF2 实现效率更高，比如在:TF2 的静态坐标实现、TF2 坐标变换监听器中的 Buffer 实现等

2.TF2与TF比较_静态坐标变换演示

接下来，我们通过静态坐标变换来演示TF2的实现效率。

2.1启动 TF2 与 TF 两个版本的静态坐标变换

TF2 版静态坐标变换:rosrun tf2_ros static_transform_publisher 0 0 0 0 0 0 /base_link /laser

TF 版静态坐标变换:rosrun tf static_transform_publisher 0 0 0 0 0 0 /base_link /laser 100

会发现，TF 版本的启动中最后多一个参数，该参数是指定发布频率

2.2运行结果比对

使用rostopic查看话题，包含/tf与/tf_static, 前者是 TF 发布的话题，后者是 TF2 发布的话题，分别调用命令打印二者的话题消息

rostopic echo /tf: 当前会循环输出坐标系信息

rostopic echo /tf_static: 坐标系信息只有一次

2.3结论

如果是静态坐标转换，那么不同坐标系之间的相对状态是固定的，既然是固定的，那么没有必要重复发布坐标系的转换消息，很显然的，tf2 实现较之于 tf 更为高效

APS2023
关注
  • 16
    点赞
  • 踩
  • 21
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
专栏目录
ROS学习笔记（13）坐标变换（TF和TF2）
weixin_75067193的博客
04-20 799
TF和TF2
机器人操作系统ROS（六）：TF坐标变换
博学而笃志，切问而近思。
03-07 1541
机器人操作系统ROS（六）：TF坐标变换
ROS学习（十四）--TF坐标变换
最新发布
2201_75563228的博客
03-26 1449
TF（Transform）坐标变换是一种在机器人学和计算机视觉领域常用的技术，用于在不同坐标系之间进行转换和变换操作。TF是ROS（Robot Operating System）中的一个模块，提供了强大的坐标变换功能。在TF中，坐标变换是通过维护一个坐标变换树（Coordinate Frame Tree）来实现的。坐标变换树是由多个坐标系组成的层次结构，每个坐标系都有一个唯一的名称，称为Frame ID。树的根节点是一个固定的全局参考坐标系，通常称为"world"或"map"
ROS的TF变换理解
qq_43526137的博客
11-05 1795
ROS的TF变换理解
ROS-TF的学习
weixin_68063596的博客
12-29 496
ros-tf
[ROS 系列学习教程] TF坐标变换 - 静态坐标变换
淋曦的进击手记
01-01 1794
如前文所属，ROS通过广播的形式告知各模块的位姿关系，接下来详述这一机制的代码实现。模块间的位置关系有两种类型，一种是相对固定的，称为静态坐标变换，一种是相对不固定，变化的，称为动态坐标变换。
【ROS入门教程】---- 10 TF坐标变换的原理及编程实现
lc1852109的博客
06-18 1674
本节博客主要介绍了TF坐标管理系统，从机器人的基本坐标变换出发，介绍了TF功能包的作用，并介绍了多种可视化方法，最后通过C++编程，自行实现了对于海龟跟踪demo的模拟
ROS坐标系中base_link和base_footprint的区别
01-07
在学tf坐标变换时，误以为这两个是一个意思，并且在一篇博客中看到的解释也是：两者一样，只不过在turtlebot中是叫base_footprint。 后来在一段代码中看到base_footprint到base_link的坐标变换是：0 0 0.1 0 0 0，才...
课件_ROS机械臂开发_4.ROS机械臂开发中的主角MoveIt!.pdf
03-10
中用于描述机器人在笛卡尔坐标系下的运动轨迹的组件。逆向运动学是MoveIt!中用于描述机器人运动中的逆向运动学问题的组件。 正向运动学是MoveIt!中用于描述机器人运动中的正向运动学问题的组件。规划有效性是MoveIt...
ros入门教程（十）– TF & URDF
01-06
文章目录TFTF树TF消息格式TransformStamped.msgtf/tfMessage.msg & tf2_msgs/TFMessage.msgtf in C++TF相关...TF是指机器人学里的坐标变换，不管SLAM还是机械臂的的运动都会涉及到坐标系的表换。 URDF是统一机器人描述
kitti_odom_to_bag:将kitod里程表点云序列转换为rosbag并将pose转换为tf
05-10
KITTI Odometry to ROSbag This python tool is aimed to solve...​ 这个python工具用来将下载的Kitti数据集中的Velodyne Points 转为rosbag，并且可以将其中的位姿信息通过tf的形式发布出来。 run python wjx_kitti.p
5ROS仿真.pptx
09-20
TF系统用于管理机器人坐标系之间的转换，如`base_link`到`base_laser`，`base_footprint`到`base_link`，`odom`到`base_footprint`，`base_link`到`camera`。 14. **Teleop Twist Keyboard**： `ros-indigo-...
ROS之坐标系关系查看
如果想成为中心，那么就到中心去吧。
01-06 343
在机器人系统中，涉及的坐标系有多个，为了方便查看，ros 提供了专门的工具，可以用于生成显示坐标系关系的 pdf 文件，该文件包含树形结构的坐标系图谱。
ROS中TF(坐标系转换)原理与使用
m0_53316604的博客
03-23 1920
TF(TransForm)，就是坐标转换，包括了位置和姿态两个方面的变换。注意区分坐标转换和坐标系转换。坐标转换是一个坐标在不同坐标系下的表示，而坐标系转换不同坐标系的相对位姿关系。ROS中机器人模型包含大量的部件，每一个部件统称之为link（比如手部、头部、某个关节、某个连杆）,每一个link上面对应着一个frame（坐标系）, 用frame表示该部件的坐标系，frame和link是绑定在一起的。可以被当做是一种标准规范，这套标准定义了坐标转换的数据格式和数据结构．tf本质是树状的数据结构，即。
TF 坐标变换(已整理)
qq_42731062的博客
07-20 1489
ros坐标变化
ROS中的坐标与坐标系转换
张飞飞的博客
10-04 5555
ROS中的TF 官网建议新工作直接使用tf2，因为它有一个更清洁的界面，和更好的使用体验。（自ROS Hydro以来，tf第一代已被“弃用”，转而支持tf2） TF介绍 TF(TransForm)，就是坐标转换，包括了位置和姿态两个方面的变换。注意区分坐标转换和坐标系转换。 坐标转换是一个坐标在不同坐标系下的表示，而坐标系转换不同坐标系的相对位姿关系。 ROS中机器人模型包含大量的部件，每一个部件统称之为link（比如手部、头部、某个关节、某个连杆）,每一个link上面对应着一个frame（坐标系）, 用f
ROS-TF的使用（常用功能）
liuzubing的博客
07-12 1万+
https://blog.csdn.net/u010876294/article/details/75004903 一、TF中的数据格式： 这些数据格式全都是class 头文件：#include <tf/transform_datatypes.h>基本上可以包含所有的tf数据类型 （1）tf::Vector3 tf::Vector3 point; 默认构造一个对象：tf::...
ROS探索总结（十八）——重读tf
热门推荐
古月居
12-02 3万+
在之前的博客中，有讲解tf的相关内容，本篇博客重新整理了tf的介绍和学习内容，对tf的认识会更加系统。1 tf简介1.1 什么是tf        tf是一个让用户随时间跟踪多个参考系的功能包，它使用一种树型数据结构，根据时间缓冲并维护多个参考系之间的坐标变换关系，可以帮助用户在任意时间，将点、向量等数据的坐标，在两个参考系中完成坐标变换。        tf的相关设计思想，可以参见：tf设计 1
ros之tf简介[tf-Package Summary]
mystical的博客
02-22 1239
译者注 第一次翻译技术类文章，难免有许多疏漏，还望见谅。 所使用的ros版本是kinetic 原文地址 以下是译文 tf包的简介 tf是一个允许用户时刻跟踪多个坐标框架的包，它及时地维持树结构中的坐标帧之间的关系，并允许用户在任何时间点变换任何两个坐标帧之间的点、向量等。 变化：自ROS Hydro以来，tf已被“弃用”，转而支持tf2。 tf2是对tf的新版，在更加有效地提供原有功能的基础上...
ros怎么实现坐标系与坐标系之间的变换
05-29
在ROS中，坐标系与坐标系之间的变换是通过tf（transform）包来实现的。tf包提供了一种方便的方式来管理坐标系之间的关系，并且能够自动地计算出不同坐标系之间的变换。下面是一个简单的例子，演示如何通过tf来实现坐标系之间的变换。 假设我们有两个坐标系，分别为`/world`和`/robot_base`，我们想要将`/robot_base`坐标系中的一个点`(x, y, z)`变换到`/world`坐标系中。我们可以按照以下步骤进行： 1. 创建一个`tf::Transform`对象，表示`/robot_base`坐标系相对于`/world`坐标系的变换。 ```cpp tf::Transform transform; transform.setOrigin(tf::Vector3(x, y, z)); // 设置变换的平移部分 transform.setRotation(tf::Quaternion(0, 0, 0, 1)); // 设置变换的旋转部分 ``` 2. 发布`/robot_base`坐标系相对于`/world`坐标系的变换。 ```cpp static tf::TransformBroadcaster br; br.sendTransform(tf::StampedTransform(transform, ros::Time::now(), "/world", "/robot_base")); ``` 3. 在需要使用变换后的点的节点中，通过tf监听器（tf listener）获取变换后的点。 ```cpp tf::TransformListener listener; tf::StampedTransform transform; listener.waitForTransform("/world", "/robot_base", ros::Time(0), ros::Duration(1.0)); // 等待获取变换信息 listener.lookupTransform("/world", "/robot_base", ros::Time(0), transform); // 获取变换信息 tf::Vector3 point(x, y, z); tf::Vector3 transformed_point = transform * point; // 计算变换后的点 ``` 通过以上步骤，我们就可以将`/robot_base`坐标系中的点`(x, y, z)`变换到`/world`坐标系中了。需要注意的是，tf的变换是从目标坐标系到源坐标系的变换，因此在发布变换信息时，需要指定目标坐标系和源坐标系的名称。

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

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

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

APS2023

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付：¥1
获取中
扫码支付

您的余额不足，请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

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

余额充值