【ROS2机器人入门到实战】建图前准备2-发布 Odom 的 TF

已于 2024-04-27 17:18:46 修改
阅读量4.5k 收藏 35
点赞数 6
分类专栏： ROS2机器人入门到实战 文章标签： 机器人 ROS2 MicroROS Odom TF
于 2023-09-01 11:54:20 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_27865227/article/details/132621223
版权

3.建图前准备2-发布 Odom 的 TF

写在前面

  1. 当前平台文章汇总地址：ROS2机器人从入门到实战
  2. 获取完整教程及配套资料代码，请关注公众号<鱼香ROS>获取
  3. 教程配套机器人开发平台：两驱版| 四驱版
  4. 为方便交流，搭建了机器人技术问答社区：地址 fishros.org.cn

上一节我们简单了解了 ROS 中对移动机器人坐标系变换的规定如下：
odom
base_link
map
earth
laser/imu...

运行建图算法时，会得到 map 到 odom 之间的TF，base_link 到 雷达或者IMU 之间的坐标关系一般使用URDF进行描述，然后使用 robot_state_publisher 进行发布，也可以使用静态TF直接发布。

而 odom 到 base_link 之间的TF就需要我们从里程计中提取并发布，本节我们主要的工作就是订阅 里程计话题 发布 odom 到 base_link 之间的 TF 变换。

关于base_link和base_footprint 的区别

在机器人领域中，"base_link"和"base_footprint"是ROS（Robot Operating System）中两个常用的坐标系（frames）名称。它们用于表示机器人的基本参考坐标系，但在某些情况下，它们可能会有一些微妙的区别。

  1. base_link：
    "base_link"通常用于表示机器人的实际底盘或主体的坐标系。这个坐标系通常与机器人的物理结构直接相关，它可能位于机器人底盘的中心或者其他适当的位置。例如，对于一个移动机器人，"base_link"的原点可能位于机器人的几何中心或底盘的旋转中心，这取决于机器人的设计。

  2. base_footprint：
    "base_footprint"则更多地被用作机器人在地面上的一个虚拟平面的参考点，通常是机器人底盘的投影点。这个坐标系通常位于机器人底盘底部，用于表示机器人与地面的接触点。它可以被认为是机器人底部的一个虚拟标记，用来执行路径规划、避障和定位等任务。

在许多情况下，“base_link"和"base_footprint"的坐标原点可能是相同的，但它们的用途和表示方式略有不同。例如，在路径规划中，可能更常用"base_footprint”，因为它更接近机器人在地面上的实际位置，有助于避免碰撞。而在其他情况下，如控制机器人的运动，使用"base_link"可能更合适，因为它更直接地与机器人的物理结构相联系。

一、创建功能包

创建fishbot工作空间和功能包fishbot_bringup

mkdir -p ~/fishbot_ws/src
cd ~/fishbot_ws/src
ros2 pkg create --build-type ament_cmake fishbot_bringup

二、编写代码

在 src/fishbot_bringup/src/ 下新建 fishbot_bringup.cpp

#include <rclcpp/rclcpp.hpp>
#include <nav_msgs/msg/odometry.hpp>
#include <tf2/utils.h>
#include <tf2_ros/transform_broadcaster.h>

class TopicSubscribe01 : public rclcpp::Node
{
public:
  TopicSubscribe01(std::string name) : Node(name)
  {
    // 创建一个订阅者，订阅"odom"话题的nav_msgs::msg::Odometry类型消息
    odom_subscribe_ = this->create_subscription<nav_msgs::msg::Odometry>(
      "odom", rclcpp::SensorDataQoS(),
      std::bind(&TopicSubscribe01::odom_callback, this, std::placeholders::_1));

    // 创建一个tf2_ros::TransformBroadcaster用于广播坐标变换
    tf_broadcaster_ = std::make_unique<tf2_ros::TransformBroadcaster>(this);
  }

private:
  rclcpp::Subscription<nav_msgs::msg::Odometry>::SharedPtr odom_subscribe_;
  std::unique_ptr<tf2_ros::TransformBroadcaster> tf_broadcaster_;
  nav_msgs::msg::Odometry odom_msg_;

  // 回调函数，处理接收到的odom消息
  void odom_callback(const nav_msgs::msg::Odometry::SharedPtr msg)
  {
    (void)msg;
    RCLCPP_INFO(this->get_logger(), "接收到里程计信息->底盘坐标系 tf :(%f,%f)", 
                msg->pose.pose.position.x, msg->pose.pose.position.y);

    // 更新odom_msg_的姿态信息
    odom_msg_.pose.pose.position.x = msg->pose.pose.position.x;
    odom_msg_.pose.pose.position.y = msg->pose.pose.position.y;
    odom_msg_.pose.pose.position.z = msg->pose.pose.position.z;

    odom_msg_.pose.pose.orientation.x = msg->pose.pose.orientation.x;
    odom_msg_.pose.pose.orientation.y = msg->pose.pose.orientation.y;
    odom_msg_.pose.pose.orientation.z = msg->pose.pose.orientation.z;
    odom_msg_.pose.pose.orientation.w = msg->pose.pose.orientation.w;
  };

public:
  // 发布坐标变换信息
  void publish_tf()
  {
    geometry_msgs::msg::TransformStamped transform;
    double seconds = this->now().seconds();
    transform.header.stamp = rclcpp::Time(static_cast<uint64_t>(seconds * 1e9));
    transform.header.frame_id = "odom";
    transform.child_frame_id = "base_footprint";

    transform.transform.translation.x = odom_msg_.pose.pose.position.x;
    transform.transform.translation.y = odom_msg_.pose.pose.position.y;
    transform.transform.translation.z = odom_msg_.pose.pose.position.z;
    transform.transform.rotation.x = odom_msg_.pose.pose.orientation.x;
    transform.transform.rotation.y = odom_msg_.pose.pose.orientation.y;
    transform.transform.rotation.z = odom_msg_.pose.pose.orientation.z;
    transform.transform.rotation.w = odom_msg_.pose.pose.orientation.w;

    // 广播坐标变换信息
    tf_broadcaster_->sendTransform(transform);
  }
};

int main(int argc, char **argv)
{
  // 初始化ROS节点
  rclcpp::init(argc, argv);

  // 创建一个TopicSubscribe01节点
  auto node = std::make_shared<TopicSubscribe01>("fishbot_bringup");

  // 设置循环频率
  rclcpp::WallRate loop_rate(20.0);
  while (rclcpp::ok())
  {
    // 处理回调函数
    rclcpp::spin_some(node);

    // 发布坐标变换信息
    node->publish_tf();

    // 控制循环频率
    loop_rate.sleep();
  }

  // 关闭ROS节点
  rclcpp::shutdown();
  return 0;
}

修改CMakeLists.txt

cmake_minimum_required(VERSION 3.8)
project(fishbot_bringup)

if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
  add_compile_options(-Wall -Wextra -Wpedantic)
endif()

# find dependencies
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED)
find_package(geometry_msgs REQUIRED)
find_package(nav_msgs REQUIRED)
find_package(tf2 REQUIRED)
find_package(tf2_ros REQUIRED)


set(dependencies
  rclcpp
  geometry_msgs
  nav_msgs
  tf2
  tf2_ros
)

# uncomment the following section in order to fill in
# further dependencies manually.
# find_package(<dependency> REQUIRED)

add_executable(fishbot_bringup src/fishbot_bringup.cpp)
target_include_directories(fishbot_bringup PUBLIC
  $<BUILD_INTERFACE:${CMAKE_CURRENT_SOURCE_DIR}/include>
  $<INSTALL_INTERFACE:include>)
target_compile_features(fishbot_bringup PUBLIC c_std_99 cxx_std_17)  # Require C99 and C++17

ament_target_dependencies(fishbot_bringup
  ${dependencies}
)
install(TARGETS fishbot_bringup
  DESTINATION lib/${PROJECT_NAME})

if(BUILD_TESTING)
  find_package(ament_lint_auto REQUIRED)
  # the following line skips the linter which checks for copyrights
  # comment the line when a copyright and license is added to all source files
  set(ament_cmake_copyright_FOUND TRUE)
  # the following line skips cpplint (only works in a git repo)
  # comment the line when this package is in a git repo and when
  # a copyright and license is added to all source files
  set(ament_cmake_cpplint_FOUND TRUE)
  ament_lint_auto_find_test_dependencies()
endif()



ament_package()

三、测试运行

编译运行节点

colcon build
source install/setup.bash
ros2 run fishbot_bringup fishbot_bringup

接着运行MicroROS Agent，发布 odom 话题出来

ros2 run fishbot_bringup fishbot_bringup
---
[INFO] [1692340618.330952225] [fishbot_bringup]: recv odom->base_footprint tf :(0.001754,0.000030)
[INFO] [1692340618.379986197] [fishbot_bringup]: recv odom->base_footprint tf :(0.001754,0.000030)
[INFO] [1692340618.434032295] [fishbot_bringup]: recv odom->base_footprint tf :(0.001754,0.000030)
[INFO] [1692340618.480949009] [fishbot_bringup]: recv odom->base_footprint tf :(0.001754,0.000030)
[INFO] [1692340618.535952833] [fishbot_bringup]: recv odom->base_footprint tf :(0.001754,0.000030)

接着我们来查看下TF

ros2 run rqt_tf_tree rqt_tf_tree

结果如下

在这里插入图片描述

四、总结

有了 odom 到 base_link/base_footprint 之间的变换，接下来我们来搞定 base_link 到机器人各个组件之间的变换。

【ROS2】坐标TF发布（动态）
郭老二
12-25 165
ROS2发布动态坐标：tf2_ros::TransformBroadcaster
ROS2入门到精通—— 2-10 ROS2实战：自定义规划插件——基于录制的固定路径的全局规划
BigDavid123的博客
07-24 978
本文实现了自定义规划插件：基于录制的固定路径的全局规划
odom->base_link
无穷山色
05-06 2094
turtle_tf_listener.cpp#include #include #include using namespace std; double x,y,z,ww,zz,hh,ii,Aww,Azz,Ahh,Aii; int main(int argc, char** argv){ ros::init(argc, argv, "my_tf_listener"); ros::N
ros中发布odom的topic
07-17
一个ros节点，发布一个话题，名字是odom。odm可以表示机器人的位置
ROS中发布odom的话题节点
gitblog_06749的博客
05-01 256
ROS中发布odom的话题节点 【下载地址】ROS中发布odom的话题节点 这是一个专为ROS（机器人操作系统）设计的开源项目，核心功能是发布名为odom的话题，用于实时传递机器人的位置信息。通过该节点，开发者可以轻松获取机器人在环境中的坐标数据，为导航和定位等功能的实现提供支持。项目使用简单，只需克隆代码、编译节点并启...
PIBOT移植ROS2记录(4)-odom与tf
PIBOT导航机器人
05-04 756
1. odom topic 修改头文件 #include <nav_msgs/Odometry.h>—> #include <nav_msgs/msg/odometry.hpp> 修改定义 ros::Publisher---->rclcpp::Publisher<nav_msgs::msg::Odometry>::SharedPtr nav_msgs::Odometry---->nav_msgs::msg::Odometry 创建pub对象 adve
【入门 ROS2】ROS TF发布与监听
qq_28791753的博客
12-13 953
TF是ROS中的一个库，它允许用户跟踪多个坐标系之间的相对变换。给定时刻t，某个点在不同坐标系中的位置是什么？如何将传感器数据从一个坐标系转换到另一个坐标系？
ROS平台小车，串口通讯，接收topic,发布主题
12-12
通过两个轮子的轮速，计算线速度，角速度，积分后得到里程计
【ROS2】slam_toolbox建图详解
郭老二
11-12 1376
slam_toolbox建图详解：安装、配置激光雷达、发布里程计、启动RViz2、保存地图
【机器人导航】手持激光雷达SLAM建图：ROS2环境下Yahboom小车的地图构建与可视化实现
最新发布
05-10
适合人群：对ROS2有一定了解并希望深入学习激光雷达建图技术的机器人开发者或研究人员。 使用场景及目标：①学习ROS2环境下手持激光雷达建图的具体操作流程；②掌握如何通过命令行启动雷达、发布静态odom转换、启动...
ROS2入门到精通—— 1-7 ROS2实战：行为树详解
BigDavid123的博客
07-23 1199
本文详细解读了行为树的相关概念以及源码解析
ROS2入门到精通—— 2-2 ROS2实战：运动规划仿真环境Nav2搭建和导航测试
BigDavid123的博客
07-15 564
本文概述了Nav2的框架，以及Nav2仿真环境的搭建和导航测试
ROS2代码阅读笔记1-发布里程计消息和广播相应的 TF 变换
Java_Caorui的博客
07-20 872
这个框架是机器人操作系统（ROS）的一部分，专门用于管理不同坐标系之间的变换，并提供将这些变换广播给其他节点的机制。这行代码用于发布一个坐标变换，使其他 ROS 2 节点可以获取这个变换信息。方法将新的变换信息发布到 TF 框架，使其他订阅这个变换信息的节点能够接收到并使用这些信息。用于将坐标系的变换（即从一个坐标系到另一个坐标系的姿态变化）发布到 ROS2 的。TF 框架用于跟踪多个坐标系之间的关系，并维护它们在随时间变化时的变换信息。类型的变换消息发布到 ROS 2 的 TF 框架中。
python 发送ros2 tf数据
qq_37183161的博客
04-04 395
直接上代码,仅做测试使用的demo。python发送tf数据。
【ROS2机器人入门到实战】tf2介绍
生活不止眼前的苟且
08-25 4198
TF即变换的英文单词TransForm的缩写。所以ROS和ROS2中的TF就是指和坐标变换相关的工具。在搞机器人当中，坐标变换经常用到，所以ROS2帮我们做了一个强大易用的TF工具。
ROS - tf
weixin_46300916的博客
01-07 1089
你想看看 tf 能做什么？看看 tf 介绍演示。 一个机器人系统通常有许多随时间变化的三维坐标系，如世界坐标系、基础坐标系、抓手坐标系、头部坐标系等： tf 可以在分布式系统中运行。这意味着系统中任何一台电脑上的所有 ROS 组件都能获取机器人坐标系的所有信息。没有中央转换信息服务器。 有关设计的更多信息，请参阅/设计 我们创建了一套教程，一步步指导你使用 tf。您可以从 tf 入门教程开始。要查看所有 tf 和 tf 相关教程的完整列表，请访问教程页
在ROS 2中发布nav_msgs/Odometry（里程计）消息
laocui1的博客
01-03 3715
在ROS中，TF是一种用于跟踪和广播坐标系变换的机制，它允许多个节点之间共享坐标系信息。在机器人控制中，TF通常用于描述不同坐标系之间的关系，如机器人基座坐标系（base_link）相对于全局坐标系（odom）的变换。发布的TF消息，可以被其他ROS节点监听和使用，以获取机器人在全局坐标系中的准确位置和方向信息。这对于在ROS系统中实现机器人导航和感知非常重要。用于发布机器人的里程计信息，即机器人在全局坐标系中的位置和方向变换。具体来说，它发布了一个。消息，描述了机器人的当前位姿。
ros tf
sinoai
08-07 524
欢迎访问我的博客。
ros中tf和odom的创建，转换与发布
qq_41816368的博客
02-01 1570
里程计frame系通常命名为 odom，也就是frame_id="odom"）和一个Odometry类型的topic，这个topic包含的内容是里程计frame的位置和速度，也就是根据车轮运动而计算出来的机器人的位置和速度。需要建立里程计frame到base_link的tf转换，并将这个tf发布，在rviz中设定fixed frame为odom，才能在rviz中正确看到机器人的运动。里程计 frame的位置是gps的坐标，也可以初始化一个点，使用gps的相对坐标。
ros2 发布odom话题
03-31
### 如何在ROS2中发布`odom`话题 在ROS2环境中，要实现`odom`话题的发布，通常需要创建一个自定义节点来模拟或计算机器人运动学数据并将其作为消息发送到指定的话题。以下是具体方法： #### 创建Publisher Node 可以编写一个简单的Python脚本或者C++程序用于发布`nav_msgs/msg/Odometry`类型的`odom`消息。 ##### Python示例代码 ```python import rclpy from rclpy.node import Node from nav_msgs.msg import Odometry from geometry_msgs.msg import Quaternion import math class OdomPublisher(Node): def __init__(self): super().__init__('odom_publisher') self.publisher_ = self.create_publisher(Odometry, 'odom', 10) timer_period = 0.5 # seconds self.timer = self.create_timer(timer_period, self.timer_callback) def quaternion_from_euler(self, roll, pitch, yaw): """ Converts euler angles to quaternion. """ cy = math.cos(yaw * 0.5) sy = math.sin(yaw * 0.5) cp = math.cos(pitch * 0.5) sp = math.sin(pitch * 0.5) cr = math.cos(roll * 0.5) sr = math.sin(roll * 0.5) q = Quaternion() q.w = cy * cp * cr + sy * sp * sr q.x = cy * cp * sr - sy * sp * cr q.y = sy * cp * sr + cy * sp * cr q.z = sy * cp * cr - cy * sp * sr return q def timer_callback(self): msg = Odometry() # 设置header信息 msg.header.stamp = self.get_clock().now().to_msg() msg.header.frame_id = "odom" # 设置child_frame_id msg.child_frame_id = "base_link" # 设置位置信息 msg.pose.pose.position.x = 0.0 msg.pose.pose.position.y = 0.0 msg.pose.pose.position.z = 0.0 # 使用欧拉角转换四元数表示方向 quat = self.quaternion_from_euler(0., 0., math.pi / 4.) msg.pose.pose.orientation = quat # 设置线速度和角速度 msg.twist.twist.linear.x = 0.5 msg.twist.twist.angular.z = 0.2 self.publisher_.publish(msg) def main(args=None): rclpy.init(args=args) odom_publisher = OdomPublisher() rclpy.spin(odom_publisher) odom_publisher.destroy_node() rclpy.shutdown() if __name__ == '__main__': main() ``` 上述代码展示了如何构建一个发布器节点，并定期向`odom`话题发送带有位姿和速度的消息[^6]。 #### C++ 示例代码 对于偏好C++开发环境的情况，则可采用如下方式实现相同的功能： ```cpp #include "rclcpp/rclcpp.hpp" #include "nav_msgs/msg/odometry.hpp" #include "geometry_msgs/msg/quaternion.hpp" #include <cmath> using namespace std::chrono_literals; class OdomPublisher : public rclcpp::Node { public: OdomPublisher(): Node("odom_publisher") { publisher_ = this->create_publisher<nav_msgs::msg::Odometry>("odom", 10); auto timer_callback = [this]() -> void { auto message = nav_msgs::msg::Odometry(); // Set header information message.header.stamp = this->get_clock()->now(); message.header.frame_id = "odom"; // Set child frame id message.child_frame_id = "base_link"; // Position setup message.pose.pose.position.x = 0.0; message.pose.pose.position.y = 0.0; message.pose.pose.position.z = 0.0; // Orientation as quaternion from Euler angle conversion double roll = 0.; double pitch = 0.; double yaw = M_PI / 4.; tf2::Quaternion quat; quat.setRPY(roll, pitch, yaw); message.pose.pose.orientation.w = quat.w(); message.pose.pose.orientation.x = quat.x(); message.pose.pose.orientation.y = quat.y(); message.pose.pose.orientation.z = quat.z(); // Velocity components message.twist.twist.linear.x = 0.5; message.twist.twist.angular.z = 0.2; RCLCPP_INFO(this->get_logger(), "Publishing odometry..."); publisher_->publish(message); }; timer_ = this->create_wall_timer(500ms, timer_callback); } private: rclcpp::TimerBase::SharedPtr timer_; rclcpp::Publisher<nav_msgs::msg::Odometry>::SharedPtr publisher_;}; int main(int argc, char **argv){ rclcpp::init(argc, argv); auto node = std::make_shared<OdomPublisher>(); rclcpp::spin(node); rclcpp::shutdown(); return 0;} ``` 此段代码同样实现了周期性的`odom`消息广播功能[^7]。 #### 验证Topic频率 为了验证发布的`odom`话题是否正常工作以及其更新速率，可以通过以下命令检查： ```bash ros2 topic hz /odom ``` 这将返回该特定主题的平均发布频率信息[^8]。 #### 总结 通过以上两种编程语言实例可以看出，在ROS2框架下无论是利用Python还是C++都可以轻松完成定制化的需求——即定时推送包含机器人状态估计在内的导航里程计数据至订阅端口供后续处理分析之用。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值