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

机器人导航学习历程(一)简介 机器人导航简介   导航可以说是机器人最基本的功能之一,简单来说,导航就是机器人基于地图,实现从起始点前进到目标点的过程,这个过程中要求不发生碰撞并满足自身动力学模型(如不超过速度、加速度等限制)。   将导航的任务进行细分,首先机器人在未知环境中需要使用激光传感器(或者是深度传感器)进行地图构建,然后根据构建的地图进行定位,有了地图和定位的基础,就可以根据目标点以及感知的障碍物信息进行路径规划... 阅读详情
AI摘要

本文介绍如何在ROS中发布并显示里程计消息。通过创建一个发布节点,该节点能够绕原点转圈并发送里程计数据。同时,文章详细说明了如何在rviz中配置并显示这些数据。

由于tf只能表示机器人相对与全局地图 world的位置关系,而里程计消息不但能表示位置还能够表示向量信息。

里程计消息nav_msgs/Odometry 结构如下
Header header
string child_frame_id
geometry_msgs/PoseWithCovariance pose
geometry_msgs/TwistWithCovariance twist

ROS中可以发布里程计消息,并在rviz中显示。
本文参考wiki上的教程实现在rviz中显示里程计的功能
http://wiki.ros.org/navigation/Tutorials/RobotSetup/Odom
步骤
(1)创建里程计发布节点
(2)在rviz中显示

1.创建里程计发布节点

(1)编译代码
此节点实现的功能是绕原点转圈
代码如下

#include <ros/ros.h>
#include <tf/transform_broadcaster.h>
#include <nav_msgs/Odometry.h>

int main(int argc, char** argv){
  ros::init(argc, argv, "odometry");

  ros::NodeHandle n;
  ros::Publisher odom_pub = n.advertise<nav_msgs::Odometry>("odom", 50);
  tf::TransformBroadcaster odom_broadcaster;

  double x = 0.0;
  double y = 0.0;
  double th = 0.0;

  double vx = 0.1;
  double vy = -0.1;
  double vth = 0.1;

  ros::Time current_time, last_time;
  current_time = ros::Time::now();
  last_time = ros::Time::now();

  ros::Rate r(1.0);
  while(n.ok()){

    ros::spinOnce();               // check for incoming messages
    current_time = ros::Time::now();

    //compute odometry in a typical way given the velocities of the robot
    double dt = (current_time - last_time).toSec();
    double delta_x = (vx * cos(th) - vy * sin(th)) * dt;
    double delta_y = (vx * sin(th) + vy * cos(th)) * dt;
    double delta_th = vth * dt;

    x += delta_x;
    y += delta_y;
    th += delta_th;

    //since all odometry is 6DOF we'll need a quaternion created from yaw
    geometry_msgs::Quaternion odom_quat = tf::createQuaternionMsgFromYaw(th);

    //first, we'll publish the transform over tf
    geometry_msgs::TransformStamped odom_trans;
    odom_trans.header.stamp = current_time;
    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.translation.z = 0.0;
    odom_trans.transform.rotation = odom_quat;

    //send the transform
    odom_broadcaster.sendTransform(odom_trans);

    //next, we'll publish the odometry message over ROS
    nav_msgs::Odometry odom;
    odom.header.stamp = current_time;
    odom.header.frame_id = "odom";

    //set the position
    odom.pose.pose.position.x = x;
    odom.pose.pose.position.y = y;
    odom.pose.pose.position.z = 0.0;
    odom.pose.pose.orientation = odom_quat;

    //set the velocity
    odom.child_frame_id = "base_link";
    odom.twist.twist.linear.x = vx;
    odom.twist.twist.linear.y = vy;
    odom.twist.twist.angular.z = vth;

    //publish the message
    odom_pub.publish(odom);

    last_time = current_time;
    r.sleep();
  }
}

(2)启动节点
编译的包名为learning_tf 节点为编译好的可执行程序odometry
rosrun learning_tf odometry

2.在rviz中显示

rosrun rviz rviz

在左边Display 配置属性,fixed frame选择为odom,add 选项加入Odemetry,在topic下拉框中选择/odem

3实验结果

这里写图片描述

是不是发现和http://blog.csdn.net/ktigerhero3/article/details/64906315
中的示例相似,示例中机器人运动发布的就是里程计数据。

ROS仿真机器人实现Rviz轨迹显示 3、启动导航的launch文件中添加启动该cpp文件。1、导航包中创建.cpp文件,并将以下代码复制进去。2、CMakeLists当中添加可执行文件及链接库。 阅读详情

相关推荐

ROS导航实战:从零解析里程计消息的发布与订阅

本文详细解析了ROS导航中里程计消息的发布与订阅实战,从理解`nav_msgs/Odometry`消息结构到搭建TurtleBot3仿真环境,再到编写发布与订阅节点代码。通过TF变换、协方差矩阵设置等高级技巧,帮助开发者实现精准的机器人定位与导航,并最终与ROS导航栈集成。

weixin_30432579的博客 452

将odometry消息转换成path消息来实现rviz的直观可视化。(功能极简版)

将nav_msgs::odometry类型数据转换到nav_msgs::path,从而方便在rviz上查看。例如将t265的定位信息放到rviz上进行可视化观看(类似官方那个realsense-viewer的视觉效果)。

T_T___T_T的博客 1274

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

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

weixin_26854829的博客 452

ROS综合运动控制:rviz里程计查看

赵虚左老师学习笔记,ROS综合运动控制,rviz里程计查看方法

weixin_45205599的博客 1420

ROS2 Windows实战:在Windows 10上启动并配置rviz2可视化机器人运动

本文详细指导在Windows 10系统上配置ROS2 Foxy环境并启动rviz2可视化工具。通过安装ROS2、创建工作空间、编写模拟机器人节点,并配合键盘控制,最终在rviz2中实时可视化机器人运动轨迹,为Windows平台的机器人算法开发与调试提供了完整实战方案。

weixin_29210727的博客 475

ROS之rviz显示(visualization_msgs/Marker)

(1)在ROS中,odombase_link和map是常见的坐标系(frame)用于机器人定位和导航。odom坐标系是机器人的里程计坐标系,相对于起始位置的运动。base_link坐标系是机器人的本体坐标系,与机器人的移动无关。map坐标系是机器人所在的全局地图坐标系,提供了固定的参考框架用于定位和导航机器人在全局环境中的位置。(2)是ROS中的消息类型,用于在RViz中发布多个Marker的数组消息由以下字段组成:markers():包含多个对象的数组。

BigDavid123的博客 1万+

从零搭建一辆ROS小车(二)发布里程计数据在rviz中显示

1、创建功能包 创建odom_tf_package功能包 cd ~/catkin_ws/src catkin_create_pkg odom_tf_package std_msgs rospy roscpp 创建odom_tf_pub节点   在src文件夹下新建odom_tf_pub.cpp,代码如下 : (注意第四行的头文件,是上一篇文章所提到的自定义消息编译生成的,所以在编...

Maxen的博客 6225

ROS机器人里程计模型

3.5 移动机器人系统模型 相信大家的机器人平台STM32端底层控制和机器人urdf建模都已经顺利完成了,在正式开始ros端编写机器人启动功能包之前,我们还不得不学习一些必要的理论知识。别担心数学不好,这里基本都是高中数学。下面我们开始,Are you ready? 没准备好也开始了。 3.5.1 常用坐标系系统模型 在移动机器人技术研究中,最为常用的坐标系统是笛卡尔坐标系统。而在SLAM算法研究中,有如下几个比较常见的笛卡尔坐标系统,它们分别为机器人坐标系XR YR OR 、传感器坐标系XS YS OS

「小白学移动机器人」一个专注分享移动机器人相关知识的公众号! 1万+

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

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

showing1998的博客 1万+

Tessent --- PDL

当关联的ICL模块是当前ICL顶部模块时,即当它与当前设计匹配时,只能iCall一个iTopProc。但是,可以在iTopProc内调用iCall iProc或iTopProc。为指定后续iProc命令引用的ICL模块,发出这个命令之后,随后定义的iProc都会对应的ICL模块进行定义。为后续iCall调用,当使用iCall命令调用该过程时,参数列表中的变量将被替换为iCall命令中指定的值。在调用iProc时,运行iProc内的命令。PDL是面向工程师的,工程师利用PDL语言,对ICL中的单元进行控制。

qiantianyiqian的博客 2802

ROS2进程内通信:零拷贝Intra-Process原理与实战

Intra-Process通信是ROS2实现低延迟节点间数据交换的核心机制,其本质是通过C++17智能指针与零拷贝共享内存,在同一进程内绕过序列化、系统调用和上下文切换。相比传统DDS跨进程通信,它将`geometry_msgs::Twist`类消息延迟从42μs降至0.8μs,显著提升机器人实时控制性能。该技术并非自动启用,需满足同执行器、QoS严格匹配、内存所有权明确三大约束,适用于机械臂控制、视觉SLAM、图像处理流水线等对端到端延迟敏感的场景。本文聚焦ROS2原生Intra-Process通讯的原理

weixin_30619101的博客 366

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

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

robot123654的博客 2772

【Unity】NGUI下载与导入

Unity3D插件NGUI的下载和导入。

Get your hands dirty 3万+

【ROS总结】 ROS接口——Odometry

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

ROS小生的博客 9881

Halcon学习之一维测量(3)

带定位器的测量。首先看一下“定位”是什么意思?回答:比如我们测量一个芯片,这时候我们设置一个测量矩形,来沿着测量目标进行测量。但是下一张当芯片的位置发生变化时,测量矩形的位置就不对了,就不是沿着测量目标了。这样就不对了!芯片在转,测量矩形也要跟着一起转才行。这个时候就需要“定位”来起作用了!定位之后得到这个芯片的旋转角度之后,测量矩形可以跟着这个角度转。这就是“定位”+“测量”,这是我们工业视觉常用的一个手法,在Halcon里面也是有例子展现的。

deep_love1314的博客 789

12、每日卫星任务规划问题的不同公式

本文探讨了卫星任务规划问题的多种数学公式表示方法,包括传统的整数线性规划(ILP)模型、改进的基于路径的公式、基于集合覆盖的公式以及动态规划公式。通过案例研究比较了不同公式的求解效率和适用场景,并提供了使用Python进行实际求解的操作步骤。最后讨论了进一步优化策略及未来研究方向,旨在为解决卫星任务规划问题提供全面的理论支持和实践指导。

assembly8low的博客 207

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

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

weixin_30274627的博客 513

在ABAQUS中使用VUMAT子程序实现Hashin失效准则的详细解析与实践:深入探讨复合材料模拟仿真的高级编程技巧

Hashin失效准则是由材料科学家Shlomo Hashin于1962年提出的一种基于能量方法的多向失效理论,主要用于预测复合材料的破坏行为。与传统的单向失效理论不同,Hashin准则考虑了材料内部的多种独立破坏机制,如基体断裂、界面脱粘、纤维断裂等,这些机制在不同应力状态下可能同时或分别发生。通过计算各个机制的能量释放率,Hashin失效准则能够更为准确地预测复合材料在复杂应力状态下的破坏行为。

qq_38334677的博客 1953

Rviz显示机器人运动轨迹

在实际操作机器人进行移动的时候,虽然直接观察机器人本身是比较直观的,但是无法查看到机器人运动过程中比较细微的变化(比如方向的变化),那么就需要将机器人的运动轨迹用可视化软件Rviz显示出来以便于观察。这个功能是利用Rviz中的Path类型实现的,只需要将机器人的位置信息已nav_msgs/Path类型的消息的形式发布到ROS系统中,然后在Rviz上订阅该类型的消息就可以显示机器人的运动轨迹了 下面了解一下nav_msgs/Path类型数据的数据结构: Header he...

just_do_it567的博客 6066

什么是数据挖掘?数据挖掘到底在解决什么问题?

本文我将借助5W1H的思想来带你从整体上了解一下数据挖掘。比如什么是数据挖掘为什么要做数据挖掘在哪些场景下用数据挖掘怎么做数据挖掘第一个问题,什么是数据挖掘?这个问题看似很简单,但似乎也很难有一个明确的答案。如果非要给数据挖掘一个定义的话,那么我认为数据挖掘就是寻找数据中隐含的知识,并用于产生商业价值。也就是说它是我们在数据中,尤其是在大量的数据中找到一些有价值,甚至是非常有价值的东西的一种手段。

m0_64336780的博客 1万+

论文翻译:Automatic Lesson Plan Generation via Large Language Models with Self-critique Prompting

在本文中,我们利用大型语言模型(LLMs)的理解和生成能力来自动生成定制化的课程计划。这解决了传统计划可能无法充分满足不同教学环境和学生群体的特定需求的常见挑战。我们提出了一个新颖的三阶段过程,包括使用检索增强生成(RAG)逐步生成课程计划的每个关键组成部分,通过LLMs进行自我批评,以及随后的细化。我们使用这种方法为小学2至5年级生成了涵盖80多个主题的数学课程计划。邀请了三位经验丰富的教育工作者制定全面的课程计划评估标准,然后使用这些标准将我们的LLM生成的课程计划与同一主题的实际课程计划进行基准比较。

CSPhD-winston的博客 1105

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

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

gitblog_00949的博客 854

VB摄像头监控

该VB模块可对摄像头捕获的画面进行录像等,可在创建的窗口进行控制

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

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

weixin_30915275的博客 383

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

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

NTscan扫描工具

ntscan是一个扫描器,可以扫描没有密码和弱密码的共享,先到配置文件中填写猜测的用户名和密码,扫描过程中右侧出现的是扫描日志。

ROS开发(五)—— RVIZ的相关使用

本文介绍了ROS可视化工具RViz的核心功能与使用方法。首先讲解了RViz的界面组成,包括显示面板、3D视图和工具栏。重点介绍了常用Display配置,如机器人模型、激光雷达、图像、点云、地图等数据的可视化方法。随后详细说明了坐标系设置、视角控制等实用功能,并提供了测量工具、交互控制等技巧。最后总结了数据不显示、模型异常等常见问题的解决方法。RViz作为ROS开发的重要工具,通过本文介绍的基础配置和技巧可帮助开发者快速上手,高效完成机器人系统调试。

weixin_74416579的博客 2705

迈瑞BS系列全自动生化分析仪LIS协议接口手册(内含HL7和ASTM)

迈瑞BS系列全自动生化分析仪LIS协议接口手册,内含HL7和ASTM)

从里程计到键盘控制:用RVIZ2实时监控FishBot运动状态的完整链路解析

本文详细解析了如何利用RVIZ2构建从键盘控制到实时监控的完整ROS2机器人调试链路。以FishBot为例,通过整合里程计数据、TF变换和Gazebo仿真,搭建可视化环境,帮助开发者直观验证差速控制插件的运动逻辑与位姿推算准确性,提升算法调试与评估效率。

weixin_29168675的博客 505

用ROS在RVIZ中同时显示RTK轨迹(GT)和SLAM轨迹(以视觉VINS为例)

首先我们需要安装ROS、并用小乌龟测试是否能正常运行。此外,还需要测试RVIZ是否能正常工作。

weixin_49247766的博客 2518
上一篇: linux使用定时器回调函数示例
下一篇: linux下生成动态链接库并使用(使用cmake)
火星机器人life
火星机器人life 领域专家: C/C++技术领域 领域专家: C/C++技术领域
博客等级 码龄16年 2226粉丝 293原创
评论 1
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

打赏作者

火星机器人life

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

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

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

打赏作者

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

抵扣说明:

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

余额充值
⌂ 换网址