ROS中发布里程计消息(Odometry)

ros中Odom话题与odom坐标系的理解 odom话题发表的是odom坐标系到base_link之间的转换关系,以及机器人的速度。其中base_like是机器人本体坐标系,与机器人中心重合,所以odom坐标系到base_link之间的转换关系也就是机器人在里程计坐标系中的位姿。 注:有些机器人pr_2是base_footprint是base_link原点在地面上的投影。不过在2D导航中两者表达的意思是一样的。 官网上是这么说的 The nav_msgs/Odometry message stores an estimate of the posit 阅读详情
AI摘要

本文详细介绍了在ROS环境中如何实现里程计消息的发布,包括理解里程计的概念,发布流程,以及使用C++和Python代码示例进行TF变换的过程。重点讲解了如何基于阿克曼转向结构的车辆,发布从Odom坐标系到base_link的坐标变换关系。

根据阿克曼转向结构的车辆实现里程计消息的发布,本文参考博客如下,

古月居: https://www.guyuehome.com/332
ROS WiKi:http://wiki.ros.org/cn/navigation/Tutorials/RobotSetup/Odom

1.首先理解里程计是什么?

在ROS中,里程计消息保存了机器人空间里评估的位置和速度信息。它首先是一个坐标系的变化,表示的是从Odom坐标系到base_link的坐标变化关系。其次里程计信息中含有车辆的速度信息,可以用于其他用途。里程计的坐标系原点,笔者理解为程序启动后,起始时刻的位置信息,在车辆运动后,位置和速度会发生变化,其中的TF变换关系就是当前时刻位置与起始时刻位置三维变换。要完成里程计的发布,首先应发布base_link(车辆基座标系)到里程计坐标系的TF变化。其次,发布odom信息,包含车辆的速度信息。(如有错误,请留言指正)

2.里程计发布流程

获取base_link相对于Odom的平移和旋转关系
初始化话题的TF发布者
发布Odom到base_link的TF变换
发布Odom话题

1.对TF变换以及Odom话题初始化发布者
2.获取base_link相对于Odom坐标系的位置和旋转关系
3.发布从Odom到base_link坐标的TF变换,可参考本人另一篇博客:ROS中TF变换详解
4.发布Odom话题

3.发布里程计TF变换

在本节中,编写示例代码,用于在ROS上发布nav_msgs/Odometry消息,程序由C++和python两种语言书写

2.1c++发布TF变换

在编写程序之前,需要在package.xml文件中添加依赖信息,如下:

<depend package="tf"/>
<depend package="nav_msgs"/>

2.2 python发布TF变换

首先导入库函数

from nav_msgs.msg import Odometry
from geometry_msgs.msg import TransformStamped
import tf2_ros
import tf_conversions

初始化节点等信息

	mpu = JY901()  # 初始化IMU
    rospy.init_node("IMU_pub")  # 初始化节点
    pub = rospy.Publisher("IMU", Imu, queue_size=100)  #IMU话题发布者
    odom_pub = rospy.Publisher("odom", Odometry, queue_size=100)  # 里程计话题发布者
    rate = rospy.Rate(100)  # 发送速度
    send_data = Imu()  # 要发送IMU数据
    send_Od_data = Odometry() #  要发送的Odom数据
    br = tf2_ros.TransformBroadcaster()  # 定义TF变换广播者
    trans = TransformStamped()  # 定义广播者要广播的数据类型
    x_base_link = 0
    y_base_link = 0
    z_base_link = 0
    Vx = 0
    Vy = 0
    Vz = 0
    time_now = rospy.Time.now().to_sec()
    print("start******")

思路:每次读取IMU,记录读取时间间隔。根据以及读取到的IMU数据计算出测量间隙之间的位移量,即可求得base_link相对于Odom的位移。JY901带有磁力计,通过IIC读取偏航角,转换为弧度,计算出base_link与Odom之间的旋转关系,最后用tf工具转换为欧拉角,发布TF变换和Odom话题

	Q0 = mpu.read_Q0()
	Q1 = mpu.read_Q1()
	Q2 = mpu.read_Q2()
	Q3 = mpu.read_Q3() # 从IMU读取转换好的四元数
	vx = mpu.read_velocity_x()
	vy = mpu.read_velocity_y()
	vz = mpu.read_velocity_z()  # 读取base_link三轴的角速度
	ax = mpu.read_acceleration_x()
	ay = mpu.read_acceleration_y()
	az = mpu.read_acceleration_z()  # 读取base_link三轴的加速度信息
	# data = mpu.read_yaw()  # 读取base_link的偏航角(与正东方向夹角)
	# 添加msgs的head数据

	# 发布IMU话题
	send_data.header.stamp = rospy.Time.now()
	send_data.header.frame_id = "base_link"
	# 添加四元数
	send_data.orientation.x = Q0
	send_data.orientation.y = Q1
	send_data.orientation.z = Q2
	send_data.orientation.w = Q3
	# 添加angular_velocity 角速度
	send_data.angular_velocity.x = vx
	send_data.angular_velocity.y = vy
	send_data.angular_velocity.z = vz
	# # 添加linear_acceleration
	send_data.linear_acceleration.x = ax
	send_data.linear_acceleration.y = ay
	send_data.linear_acceleration.z = az - 9.8
	# publish topic
	pub.publish(send_data)
	
	
	# 发布TF变换
	time_last = time_now
	time_now = rospy.Time.now().to_sec()
	delta_t = time_now - time_last  # 计算时间间隔
	delta_x = vx*delta_t
	delta_y = vy*delta_t
	delta_z = vz*delta_t
	
	Vx = Vx + ax*delta_t
	Vy = Vy + ay*delta_t
	Vz = Vz + az*delta_t
	delta_x = 0.5*Vx*delta_t
	delta_y = 0.5*Vy*delta_t
	delta_z = 0.5*Vz*delta_t
	# TF transform  odom->base_link
	trans.header.stamp = rospy.Time.now()
	trans.header.frame_id = "odom"
	trans.child_frame_id = "base_link"
	trans.transform.translation.x = x_base_link
	trans.transform.translation.y = y_base_link
	trans.transform.translation.z = z_base_link
	# 从偏航角解算出对应的四元数,只考虑平面运动
	q = tf_conversions.transformations.quaternion_from_euler(0, 0, mpu.read_yaw()*pi/180.0)
	trans.transform.rotation.x = q[0]
	trans.transform.rotation.x = q[1]
	trans.transform.rotation.x = q[2]
	trans.transform.rotation.x = q[3]
	br.sendTransform(trans)
	# 发布里程计信息
	send_Od_data.header.frame_id = "odom"
	send_Od_data.header.stamp = rospy.Time.now()
	send_Od_data.child_frame_id = "base_link"
	
	send_Od_data.pose.pose.position.x = x_base_link
	send_Od_data.pose.pose.position.y = y_base_link
	send_Od_data.pose.pose.position.z = z_base_link
	
	send_Od_data.twist.twist.angular.x = vx
	send_Od_data.twist.twist.angular.y = vy
	send_Od_data.twist.twist.angular.z = vz
	odom_pub.publish(send_Od_data)
	
	rate.sleep()

[基于STM32底盘控制与ROS上层导航小车制作]第六节 ROS计算和发布里程计与tf变换 系列文章目录 第一节 stm32电机驱动与编码器读取反馈 第二节 stm32电机pid控制 第三节 stm32线速度标定 第四节 stm32添加mpu6050得到angle角度 第五节 实现STM32与ubuntu系统下的ROS串口DMA通信,传输底盘速度等信息 第六节 ROS计算和发布里程计 目录 系列文章目录 前言 1.位移信息计算 2.速度信息 3.发布里程计 二、发布tf变换 1.内容计算 2.发布tf 三.rviz查看信息与launch集成节点 总 阅读详情

相关推荐

ROS 2机器人导航实战:从零构建并发布Odometry里程计消息

本文详细介绍了如何在ROS 2中构建并发布Odometry里程计消息,涵盖Python和C++两种实现方式。通过实战代码示例,帮助开发者理解里程计的核心作用、调试技巧以及与导航栈的集成方法,提升机器人导航系统的开发效率。

weixin_26854829的博客 452

译:在ROS上发布Odometry信息

在ROS上发布Odometry信息

u013794793的博客 5498

别再只发Odometry了!ROS 2中里程计消息与TF2坐标变换的绑定发布实战

本文深入探讨了ROS 2中里程计消息(nav_msgs/Odometry)与TF2坐标变换的绑定发布实践,解决了开发者常见的RViz显示异常和导航栈工作问题。通过详细的代码示例和最佳实践,帮助开发者实现里程计数据与TF2变换的同步发布,提升机器人导航系统的稳定性和可靠性。

weixin_42536058的博客 309

【ROS总结】 ROS接口——Odometry

版本:Indigo   这篇文章主要是把平时用到的一些ROS接口梳理一下,避免无法和ros进行对接,首先ROS中相对重要的是里程计(Odometry),里程计的重要性不言而喻,如果没有里程计,不管是建立地图还是导航都不会很好的工作,相应的Odometry更新也有一些节点可以调用,本文主要用到的是ros_controllers中的差分驱动控制器,介绍文档如下,该控制器用处广泛,基本差分驱动都可以用

ROS小生的博客 9881

从零手搓一个ROS里程计节点:用Python/Arduino读取编码器发布Odometry消息

本文详细介绍了如何从零开始构建一个ROS里程计节点,使用Python和Arduino读取编码器数据并发布Odometry消息。内容涵盖硬件准备、信号采集、ROS节点架构设计、运动学模型实现及消息发布实战,特别适合两轮差分驱动机器人的基础定位需求。通过优化脉冲计数算法和配置合理的协方差矩阵,显著提升导航性能。

weixin_28737603的博客 368

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

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

郭老二 1526

别再只发Odometry了!ROS 2中TF广播与里程计消息的协同发布避坑指南

本文深入解析ROS 2中TF广播与Odometry消息的协同发布机制,帮助开发者避免常见错误。详细介绍了时间戳同步、frame_id配置、协方差矩阵设置等关键细节,并提供了Python和C++实现示例,确保导航栈集成时坐标系显示和算法运行正常。

weixin_30915275的博客 383

无人机巡检提速3倍!YOLOv8n+OpenVINO让Jetson Nano跑25FPS,还能多飞25分钟

摘要(149字): 针对无人机巡检中Jetson Nano算力不足导致的帧率低、首次推理延迟高、续航短等问题,提出YOLOv8n+OpenVINO联合优化方案: 模型轻量化:YOLOv8n参数量仅3.2M(较v8s减少71%),Jetson Nano帧率从8FPS提升至15FPS(原生),绝缘子裂纹召回率仅降3%; OpenVINO加速:AUTO模式动态分配CPU/GPU算力,首次推理延迟从500ms降至200ms,帧率再优化至25FPS; 能效提升:功耗降低40%,单次续航延长25分钟。方案已落地电力/林

专注于Python爬虫开发,分享爬虫技巧、项目实战与反爬经验,使用Scrapy、BeautifulSoup等工具,解决数据抓取难题。 1245

从IMU数据到里程计:ROS中Odometry消息的融合发布实践

本文详细介绍了在ROS中如何将IMU数据融合发布为Odometry消息的实践方法。通过解析里程计核心概念、IMU数据预处理、坐标系对齐以及ROS中的C++/Python实现方案,帮助开发者掌握TF变换与里程计发布的完整流程,并提供了误差处理、性能优化等实战经验,适用于机器人定位与导航开发。

weixin_30274627的博客 513

统信UOS服务器上,达梦DM8数据库安装避坑全记录(附大小写敏感设置)

本文详细介绍了在统信UOS服务器版上部署达梦DM8数据库的全过程,包括环境准备、安装流程、数据库实例初始化及关键参数配置,特别是大小写敏感设置的注意事项。提供了从系统配置到性能优化的完整指南,帮助用户避免常见问题,确保数据库稳定运行。

weixin_30647423的博客 334

Delta-Sigma调制(DSM)技术

前言 数字信号处理和通信系统的性能很大程度上受到了模拟信号到数字信号转换接口——ADC的精度和分辨率的限制。而传统的线性脉冲编码调制(PCM)ADC受到了制造工艺的限制,无法达到很高的分辨率。但基于Delta-Sigma调制技术的ADC可以在现有工艺下实现高分辨率(大于16位),同时由于结构简单,所以易于实现。低成本高性能使得Delta-Sigma调制技术得到了广泛的应用。 Delta-Sigma型ADC的结构原理图如下图所示: 它最大的优势在于仅用1位ADC进行数据转换,同时其模拟电路部分结构简单不需要

阿星的博客 2万+

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

在ROS中,TF是一种用于跟踪和广播坐标系变换的机制,它允许多个节点之间共享坐标系信息。在机器人控制中,TF通常用于描述不同坐标系之间的关系,如机器人基座坐标系(base_link)相对于全局坐标系(odom)的变换。发布的TF消息,可以被其他ROS节点监听和使用,以获取机器人在全局坐标系中的准确位置和方向信息。这对于在ROS系统中实现机器人导航和感知非常重要。用于发布机器人的里程计信息,即机器人在全局坐标系中的位置和方向变换。具体来说,它发布了一个。消息,描述了机器人的当前位姿。

laocui1的博客 4967

混合整数规划(MIP)在资源优化中的实战应用

本文深入探讨了混合整数规划(MIP)在资源优化中的实战应用,从菜市场采购到工厂调度,再到物流配送和钢铁厂切割问题。通过分支定界法和割平面法等技术,MIP能够有效解决包含整数和连续变量的复杂优化问题,提升企业运营效率。文章还介绍了现代求解器的优化策略和实际项目中的避坑指南,帮助读者更好地应用MIP技术。

weixin_30500105的博客 92

(六)ROS发布里程计(Odometry)消息并在rviz中显示

由于tf只能表示机器人相对与全局地图 world的位置关系,而里程计消息不但能表示位置还能够表示向量信息。里程计消息nav_msgs/Odometry 结构如下 Header header string child_frame_id geometry_msgs/PoseWithCovariance pose geometry_msgs/TwistWithCovariance twistRO

沧海一帆的专栏 2万+

PX4从放弃到精通(十九):串口驱动

文章目录前言一、创建进程二、编写驱动 前言 硬件: PIXHAWK4 USB转串口模块 软件: Ubuntu18.04 PX4 1.11.3固件 QGC地面站 串口助手 一、创建进程 参考:https://mbot1.blog.csdn.net/article/details/122587617 二、编写驱动 .........

超维空间科技的博客 4610

yolov8涨点系列之Concat模块改进

yolov8涨点系列之Concat模块改进

zhang1379的博客 2953

基于ROS发布里程计信息

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

BigDavid123的博客 2444

【漏洞复现】Apache Tomcat远程代码执行漏洞(CVE-2024-56337)

CVE-2024-56337是一个存在于Apache Tomcat中的TOCTOU(Time-of-Check Time-of-Use)竞争条件漏洞。此漏洞源于对先前漏洞(CVE-2024-50379)的不完整修复。若默认servlet是可写的(参数readonly设置值为false,该设置为非默认设置)表示不区分大小写文件系统,在负载下并发读取和上传同一文件可以绕过Tomcat的大小写检查。攻击者可以通过构造恶意请求上传含恶意JSP代码的文件,使其触发解析并执行这些文件,从而导致远程代码执行。

李同學AI安全 3204

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

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

Cloud_H的博客 8645

米哈游运维面试题及参考答案

Linux 系统运行级别是用于定义系统启动时所需要达到的功能状态。运行级别 0:表示系统停机状态,用于关闭系统,是系统的关机级别。当系统切换到这个级别时,会停止所有的服务和进程,然后关闭系统。运行级别 1:也称为单用户模式。在这个级别下,系统只启动基本的系统服务和必要的进程,仅允许 root 用户登录系统进行维护操作,常用于系统出现故障需要紧急修复的情况,比如修复文件系统错误、重置 root 密码等。运行级别 2:多用户模式,但不支持网络文件系统(NFS)。

大模型大数据攻城狮的专栏 749

怀旧版电脑GBC模拟器

再现原版GBC掌机的界面,电脑运行连游戏界面都一样大小,很怀旧,很真实,(英文版)强烈推荐,很小的文件,很难才找到的。

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

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

showing1998的博客 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

RU DOS版、EFI版32bit/64bit BIOS常用工具

DOS版、EFI版的RU工具,可用来查看IO、MEM、PCI、SMBIOS等资源。亲测在EFI SHELL下可用。

老版QQ原生表情gif动态

这是老版的QQ表情,不过全是动态的的,Windows照片查看器是不会动的,可以右击用浏览器打开查看,再说一遍是老版的,只是分享给宁愿用老版也要动态的人。

发布里程计传感器信息

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

weixin_34194702的博客 224

ros:发布里程计信息

里程计消息nav_msgs/Odometry 结构如下 Header header string child_frame_id geometry_msgs/PoseWithCovariance pose geometry_msgs/TwistWithCovariance twist 协方差解释: As a robot moves around, the uncertainty on i...

IQIT 3691

【思维导图】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万+

ROS中发布点云信息和里程计消息

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

hzy925的博客 5688
上一篇: Jetson nano i2c教程(MPU6050 + PCA9685)
下一篇: ubuntu 命令行界面无法使用sudo
不浪不欢
博客等级 码龄12年 179粉丝 34原创
评论 1
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明:

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

余额充值
⌂ 换网址