在ROS 2中发布nav_msgs/Odometry(里程计)消息

ROS中geometry_msgs消息类型、nav_msg消息 ROS中geometry_msgs消息类型 参考: 链接: https://blog.csdn.net/ganbaoni9yang/article/details/50060343. 官方文档:http://docs.ros.org/en/api/geometry_msgs/html/index-msg.html 消息类型 Accel AccelStamped AccelWithCovariance AccelWithCovarianceStamped Inertia InertiaStamped Poin 阅读详情
AI摘要

本文详细介绍了如何用Python和C++在RobotOperatingSystem(ROS)中创建节点,使用`nav_msgs/Odometry`消息发布机器人位置和姿态,并利用`tf2_ros::TransformBroadcaster`广播坐标系变换,以支持全局定位和机器人导航。

一、使用Python发布nav_msgs/Odometry消息

import rclpy
from rclpy.node import Node
from geometry_msgs.msg import Pose, Twist, Vector3
from nav_msgs.msg import Odometry
import tf2_ros
from tf2_ros import TransformBroadcaster
from geometry_msgs.msg import TransformStamped
import math

class OdometryPublisher(Node):
    def __init__(self):
        super().__init__('odometry_publisher')
        self.publisher = self.create_publisher(Odometry, 'odom', 10)
        self.timer = self.create_timer(0.1, self.publish_odometry)
        self.odom_frame_id = 'odom'
        self.child_frame_id = 'base_link'
        self.odom_broadcaster = TransformBroadcaster(self)

        # 初始化里程计变量
        self.x = 0.0
        self.y = 0.0
        self.theta = 0.0
        self.vx = 0.1  # 例子中使用的线速度
        self.vtheta = 0.1  # 例子中使用的角速度

    def publish_odometry(self):
        # 更新里程计信息
        self.x += self.vx * math.cos(self.theta)
        self.y += self.vx * math.sin(self.theta)
        self.theta += self.vtheta

        # 发布TransformStamped消息
        odom_trans = TransformStamped()
        odom_trans.header.stamp = self.get_clock().now().to_msg()
        odom_trans.header.frame_id = self.odom_frame_id
        odom_trans.child_frame_id = self.child_frame_id
        odom_trans.transform.translation.x = self.x
        odom_trans.transform.translation.y = self.y
        odom_trans.transform.rotation.w = math.cos(self.theta / 2)
        odom_trans.transform.rotation.z = math.sin(self.theta / 2)
        self.odom_broadcaster.sendTransform(odom_trans)

        # 发布Odometry消息
        odom_msg = Odometry()
        odom_msg.header.stamp = self.get_clock().now().to_msg()
        odom_msg.header.frame_id = self.odom_frame_id
        odom_msg.child_frame_id = self.child_frame_id
        odom_msg.pose.pose.position.x = self.x
        odom_msg.pose.pose.position.y = self.y
        odom_msg.pose.pose.orientation.w = math.cos(self.theta / 2)
        odom_msg.pose.pose.orientation.z = math.sin(self.theta / 2)
        odom_msg.twist.twist.linear.x = self.vx
        odom_msg.twist.twist.angular.z = self.vtheta

        self.publisher.publish(odom_msg)

def main(args=None):
    rclpy.init(args=args)
    node = OdometryPublisher()
    rclpy.spin(node)
    rclpy.shutdown()

if __name__ == '__main__':
    main()

二、使用C++发布nav_msgs/Odometry消息

#include "rclcpp/rclcpp.hpp"
#include "geometry_msgs/msg/pose_with_covariance_stamped.hpp"
#include "geometry_msgs/msg/twist_with_covariance_stamped.hpp"
#include "nav_msgs/msg/odometry.hpp"
#include "tf2/LinearMath/Quaternion.h"
#include "tf2_ros/transform_broadcaster.h"
#include "tf2_geometry_msgs/tf2_geometry_msgs.hpp"

class OdometryPublisher : public rclcpp::Node {
public:
    OdometryPublisher()
        : Node("odometry_publisher"), x(0.0), y(0.0), theta(0.0), vx(0.1), vtheta(0.1) {
        publisher_ = this->create_publisher<nav_msgs::msg::Odometry>("odom", 10);
        timer_ = this->create_wall_timer(std::chrono::milliseconds(100), std::bind(&OdometryPublisher::publish_odometry, this));

        odom_broadcaster_ = std::make_shared<tf2_ros::TransformBroadcaster>(this);
    }

private:
    void publish_odometry() {
        // 更新里程计信息
        x += vx * std::cos(theta);
        y += vx * std::sin(theta);
        theta += vtheta;

        // 发布TransformStamped消息
        geometry_msgs::msg::TransformStamped odom_trans;
        odom_trans.header.stamp = this->now();
        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.rotation = tf2::toMsg(tf2::Quaternion(0, 0, std::sin(theta / 2), std::cos(theta / 2)));
        odom_broadcaster_->sendTransform(odom_trans);

        // 发布Odometry消息
        nav_msgs::msg::Odometry odom_msg;
        odom_msg.header.stamp = this->now();
        odom_msg.header.frame_id = "odom";
        odom_msg.child_frame_id = "base_link";
        odom_msg.pose.pose.position.x = x;
        odom_msg.pose.pose.position.y = y;
        odom_msg.pose.pose.orientation = tf2::toMsg(tf2::Quaternion(0, 0, std::sin(theta / 2), std::cos(theta / 2)));
        odom_msg.twist.twist.linear.x = vx;
        odom_msg.twist.twist.angular.z = vtheta;

        publisher_->publish(odom_msg);
    }

    rclcpp::Publisher<nav_msgs::msg::Odometry>::SharedPtr publisher_;
    rclcpp::TimerBase::SharedPtr timer_;
    std::shared_ptr<tf2_ros::TransformBroadcaster> odom_broadcaster_;

    double x, y, theta, vx, vtheta;
};

int main(int argc, char *argv[]) {
    rclcpp::init(argc, argv);
    rclcpp::spin(std::make_shared<OdometryPublisher>());
    rclcpp::shutdown();
    return 0;
}

tf2_ros::TransformBroadcaster的作用:

在ROS中,TF是一种用于跟踪和广播坐标系变换的机制,它允许多个节点之间共享坐标系信息。在机器人控制中,TF通常用于描述不同坐标系之间的关系,如机器人基座坐标系(base_link)相对于全局坐标系(odom)的变换。

在上述的代码中,odom_broadcaster_ 用于发布机器人的里程计信息,即机器人在全局坐标系中的位置和方向变换。具体来说,它发布了一个geometry_msgs/TransformStamped消息,描述了机器人的当前位姿。

这个变换消息包含了三个关键的信息:

  • header: 包含了时间戳和坐标系的信息。
  • child_frame_id: 子坐标系的名称,即机器人坐标系(base_link)。
  • transform: 描述了从父坐标系到子坐标系的变换信息,包括平移和旋转。

在发布nav_msgs/Odometry消息之前,通过odom_broadcaster_发布的TF消息,可以被其他ROS节点监听和使用,以获取机器人在全局坐标系中的准确位置和方向信息。这对于在ROS系统中实现机器人导航和感知非常重要。

nav_msgs/Odometry.h发布机器人位姿(位置和方向)和线速度、角速度 类型的消息用于表示机器人或其他移动实体在某个时刻的位姿(位置和方向)和线速度、角速度。这些信息通常由运动学模型或其他类型的估计算法生成,例如滤波器或SLAM系统。该消息可以由移动的实体发布,或由运动追踪系统接收。所以,如果你正在编写一个机器人程序,需要处理或发布关于机器人的速度和位姿的信息,你可能会使用到。是一个ROS (Robot Operating System)的头文件,它包含了。这是一个在ROS中广泛使用的标准消息类型。消息和对应的头文件。 阅读详情

相关推荐

nav_msgs 用法汇总和代码实战

在实际应用中,地图通常由 SLAM(Simultaneous Localization and Mapping)系统生成并更新,而不是手动创建。在实际应用中,这些数据通常来自机器人的传感器数据或路径规划算法。例如,里程计数据可能是基于编码器读数和IMU数据的融合结果,而路径可能是由路径规划算法生成的。提供了地图的元数据信息,例如地图的分辨率、尺寸(宽度和高度),以及地图在世界坐标中的位置(通常为原点)。用于表示栅格地图,这在机器人的路径规划和导航中非常有用。提供了地图的元数据,如分辨率和大小。

小秋 AI SLAM 入门实战教程 2059

ROS里程计消息nav_msgs/Odometry的可视化方法

ROS中里程计的消息类型为nav_msgs/Odometry,可以利用geometry_msgs::PoseStamped消息,将其转化为nav_msgs/Path消息,从而在rviz中可视化

showing1998的博客 1万+

【ROS2】里程计(odometry)数据计算、发布

消息描述:nav_msgs::msg::Odometry 是ROS2中用发布里程计信息的消息,包括:线速度、角速度、位置和朝向消息路径:/opt/ros/humble/share/nav_msgs/msg/Odometry.msg。

郭老二 1526

ROS自学笔记二十二:导航中里程计消息

pose.pose.orientation:机器人的方向,通常以四元数表示,包括 `x`、`y`、`z` 和 `w`。- twist.twist.angular:机器人的角速度,通常包括绕 `x`、`y` 和 `z` 轴的旋转速度。- twist.twist.linear:机器人的线速度,通常包括 `x`、`y` 和 `z` 分量。- pose.pose.position:机器人的三维位置,通常包括 `x`、`y` 和 `z`。- twist:机器人的线速度和角速度信息,用于表示机器人的运动状态。

m0_71721954的博客 3505

山景BP10_128DBG开发板ADC_Key驱动

最近在学习山景BP10_128DBG开发板,想使用开发板上的按键。看了看原理图和之前用过的按键好像有点不一样。常见的按键都是判断IO口是否被拉低或拉高来判断按键是否被按下。山景BP10_128DBG开发板上的按键是ADC按键,每个按键按下之后ADC的采样值是不同的,通过ADC采样回来的值进而判断哪个按键按下。这种方式核心思想就是用一个ADC通道来节约IO口,对于IO紧张的芯片是一个不错的解决思路。

weixin_56646002的博客 1314

STM32实现薄膜压力传感器数据采集(标准库和HAL库实现)

薄膜压力传感器采集压力数据

XiaoCaiDaYong的博客 3万+

【思维导图】nav_msgs/Odometry 消息的构成及订阅

导航功能包要求机器人 能够通过里程计信息源发布包含速度信息的里程计nav_msgs/Odometry 消息; 本篇整理了nav_msgs/Odometry消息的具体结构,更加清晰一点,以及如果订阅这种类型的topic时应该如何获取数据; 了解了具体的结构后来看一下简单一点的订阅实例: typedef struct { float x; float y; float th; } POSE2D; vector<POSE2D> odom_poses; void

1万+

Element-cascader级联选择器增加全选功能

element el-cascader

weixin_44384273的博客 3734

【Nav2中文网】四、首次机器人安装指南(三)里程计设置

本教程来自:Nav2中文网 Nav2交流社区:https://fishros.org.cn/forum ROS2/Nav2千人交流群:(QQ)139707339 更多精彩教程请关注微信公众号:鱼香ROS 欢迎添加机器人小伊微信,解锁机器人学习特殊服务 里程计设置 在本指南中,我们将了解如何将机器人的里程计系统与 Nav2 集成。 首先,我们将简要介绍里程计,以及为使 Nav2 正常运行而需要发布的必要消息和转换。 接下来,我们将展示如何使用两种不同的情况设置里程计。 在第一种情况下,我们将展示如何为具.

生活不止眼前的苟且 2552

混合部署 操作系统混合部署

在openEuler Embedded 22.03中,已经集成了OpenAMP相关支持,并与openEuler的SIG Zephyr合作实现了openEuler Embedded与实时操作系统Zephyr在QEMU平台上的混合部署。具体的混合部署方式取决于设备的硬件和软件支持。例如,可以使用虚拟机软件(如VirtualBox)在Linux操作系统上运行Android虚拟机,从而实现Linux和Android的混合部署。需要注意的是,混合部署涉及到设备的硬件和软件兼容性,以及操作系统的配置和管理。

dianqicyuyan的博客 1771

表格数据学习的图神经网络综述

今天学习一篇发表在中科院一区期刊《ACM Computing Surveys》的综述文章《Graph Neural Networks for Tabular Data Learning: A Survey with Taxonomy & Directions》,该刊主要刊载计算机理论方法领域的系统性综述与教程论文,注重跨学科技术融合研究,最新的影响因子为28.0。本文的目的在于通过学习这篇文章,了解关于表格数据学习点图神经网络一些基础知识。

qq_41009600的博客 803

重头开始看NAV2文档(二)——里程计

本文参考中文文档,英文原版程计负责odom到底盘base_link的TF在NAV2中还需要发布nav_msgs/Odometry类型的消息提供机器人的位姿和速度该类型具体信息可见在Gazebo中模拟URDF模型必须保证模型中有inertia元素。

qq_56920196的博客 1974

《BiLSTM with Multi-Polarity Orthogonal Attention for Implicit Sentiment Analysis》论文阅读笔记

文章名:《BiLSTM with Multi-Polarity Orthogonal Attention for Implicit Sentiment Analysis》 作者Jiyao Wei a,1, Jian Liaoa,1, Zhenfei Yanga, Suge Wanga,b,∗, Qiang Zhaoa 年份 2019 1 Introduction 目前文本情感分析多分析带...

weixin_39036944的博客 1635

基于ROS发布里程计信息

本文详细介绍了如何基于ROS发布里程计信息

BigDavid123的博客 2444

万字长文,小白新手怎么开始做YOLO实验,从零开始教!整体思路在这里,科研指南针!

万字长文,小白新手怎么开始做YOLO实验,从零开始教!整体思路在这里,科研指南针!

Coding... 1万+

工业相机,大恒,面振相机8脚电源线和I/O触发接口线,颜色和接法说明和触发软件设定

上图: 说明一下,工业相机有TTL逻辑电平触发,也有光耦触发等。 这里一般我们用电路板驱动,就用GPIO触发模式, 这里,准备了两个GPIO触发模式,为LINE2,LINE3都可以选择,然后有一个GPIO_GND 如果,你只有一个触发接口,那么如图,选两个就好了。 实际接法如图。 ...

山云的专栏 1万+

常用消息 nav_msgs/Odometry Message

常用消息 nav_msgs/Odometry Message 1. nav_msgs/Odometry Message (里程计信息) Raw Message Definition # This represents an estimate of a position and velocity in free space. # The pose in this message should be specified in the coordinate frame given by header.fram

wangwang的博客 1万+

霍尼韦尔SoftMaster使用说明

霍尼韦尔SoftMaster使用说明

Odometry的发布和发布odom到base_link的tf变换

摘自:https://www.cnblogs.com/gary-guo/p/7215284.html Odometry的发布和发布odom到base_link的tf变换 转载自http://www.ncnynl.com/archives/201702/1328.html ROS发布nav_msgs/Odometry消息,以及通过tf从“odom”坐标系到“base_link”坐标系的转换。 在ROS上发布Odometry信息 导航包使用tf来确定机器人在世界中的位置,并将传感器数据与静态地图相关

自主无人机 PX4 ROS SLAM 路径规划 MVS等技术分享 8731

Probability and Statistics - 4th edition

Probability and Statistics - 4th edition

数学建模模型总结

这是本人在两年内准备参加数学建模竞赛搜集到的模型资料,已经经过了本人的筛选和整理,希望能够对准备参加数学建模竞赛的学弟学妹们提供一些帮助!

nav_msgs/Odometry消息的发布和tf变换

一。ROS使用tf来决定机器人的位置和静态地图中的传感器数据,但是tf中没有机器人的速度信息,所以导航功能包要求机器人 能够通过里程计信息源发布包含速度信息的里程计nav_msgs/Odometry 消息。 本篇将介绍nav_msgs/Odometry消息,并且通过代码实现消息的发布,以及tf树的变换。这里使用一个简单的例程,实现 nav_msgs/Odometry消息的发布和tf变换,通过伪造的...

天才樱木 1万+

Data-Structures-and-Algorithm-Analysis-in-Java.pdf

作者: Weiss, Mark A. 出版社: Addison Wesley Data Structures and Algorithm Analysis in Java is an “advanced algorithms” book that fits between traditional CS2 and Algorithms Analysis courses. In the old ACM Curriculum Guidelines, this course was known as CS7. This text is for readers who want to learn good programming and algorithm analysis skills simultaneously so that they can develop such programs with the maximum amo...

【cartographer_ros】四: 发布和订阅里程计odom信息

上一节介绍了激光雷达Odometry传感数据的订阅和发布。本节会介绍里程计Odom数据的发布和订阅。里程计在cartographer中主要用于前端位置预估和后端优化。

Cloud_H的博客 8645

ROS与navigation教程-发布里程计消息

说明: 介绍导航包发布里程信息的示例。 它涵盖了通过ROS发布nav_msgs/Odometry消息,以及从“odom”坐标系到tf上的“base_link”坐标系的变换。 (1)发布里程信息 导航包使用TF来确定机器人在地图中的位置,并将传感器数据与静态地图相关联。然而,TF不提供关于机器人的速度的任何信息。因此,导航包要求任何里程源都通过ROS发布TF变换和nav_msgs/Odomet...

Leo_Xj的博客 2881

【ROS2机器人入门到实战】采用MicroROS发布里程计

有了控制话题和里程计话题,底盘部分就完成的差不多了,但是对于一个合格的底盘来说,其实还有很多待完善的地方,下一节我们就来说说可以怎么完善,以及完善的后的代码。

生活不止眼前的苟且 2091

ROS传感器数据准备指南:IMU、里程计与GPS消息格式与转换技巧

ROS传感器数据准备是实现精准机器人定位的关键步骤,涉及IMU、里程计与GPS等多源数据的格式处理与转换。本指南将帮助新手快速掌握ROS传感器数据准备的核心方法,为传感器融合应用奠定基础。 ## 一、ROS传感器数据准备基础 在ROS系统中,传感器数据通常通过话题(Topic)进行传输。不同类型的传感器有着不同的消息格式,了解这些格式是数据准备的第一步。常见的传感器数据话题包括IMU的`/im

gitblog_00949的博客 854

ROS 发布读取Odometry里程计话题并可视化

在做导航定位式,通常最后的定位信息通过nav_msgs/Odometry消息类型发布,再将消息可视化在Rviz上。这种消息类型提供了机器人的位置和速度的综合信息,包括线速度和角速度,通常与时间戳和参考坐标系一起发布。:标准的消息头,包含时间戳和坐标系信息。:机器人的坐标系名称。:包含位置和方向的信息,以及这些信息的协方差。:包含线速度和角速度的信息,以及这些信息的协方差。

robot123654的博客 2772

ROS里程计:navigation/Tutorials/RobotSetup/Odom

ROS里程计:navigation/Tutorials/RobotSetup/Odom通过ROS发布里程表信息1、通过ROS发布里程表信息2、nav_msgs / Odometry消息3、使用tf发布Odometry转换4、编写代码 通过ROS发布里程表信息 描述:本教程提供了一个发布导航堆栈的里程表信息的示例。它涵盖了通过ROS发布nav_msgs / Odometry消息,以及通过 tf 从“ odom”坐标系到“ base_link”坐标系的转换。 教程级别:初学者 1、通过ROS发布里程表信息 导航

yechen1的博客 1143

通过ROS发布里程计消息

本教程解释了 nav_msgs/Odiometry 消息,并提供了分别通过 ROS 和 tf 发布消息和转换的示例代码。nav_msgs/Odometry消息存储机器人在自由空间中的位置和速度的估计值,此消息中的姿态对应于机器人在里程坐标系中的估计位置,以及用于确定该姿态估计的可选协方差。此消息中的twist对应于机器人在child frame中的速度,通常是移动底座的坐标系,以及用于确定该速度估计的可选协方差。在本节中,我们将编写一些示例代码,用于在 ROS 上发布nav_msgs/里程计消息,并使用。

m0_75034687的博客 929
上一篇: VScode安装C/C++编译器步骤
下一篇: ROS2发布LaserScan消息
laocui1
博客等级 码龄9年 2803粉丝 75原创
评论 1
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

打赏作者

laocui1

你的鼓励是我创作的最大动了

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

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

打赏作者

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

抵扣说明:

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

余额充值
⌂ 换网址