ROS(Robot Operating System)中,编写一个记录机器人速度并将其转换成轨迹

在ROS(Robot Operating System)中,编写一个记录机器人速度并将其转换成轨迹的类涉及到几个步骤。以下是一个简单的示例,展示了如何创建这样一个类,并将其放置在一个自定义的命名空间中。这个类将订阅机器人的速度信息,记录这些信息,并存储轨迹数据。
首先,你需要创建一个新的ROS包。如果你还没有创建,可以使用以下命令:

1、编写单一文件

cd ~/catkin_ws/src
catkin_create_pkg my_robot_tracker std_msgs roscpp
cd ~/catkin_ws
catkin_make
source devel/setup.bash

然后,在你的包中创建一个C++源文件,比如 tracker_node.cpp ,并添加以下代码:

#include <ros/ros.h>
#include <nav_msgs/Odometry.h>
#include <geometry_msgs/PoseStamped.h>
#include <vector>namespace my_robot_tracker {class TrajectoryRecorder {
public:TrajectoryRecorder() {// 初始化ROS节点ros::NodeHandle nh;// 订阅机器人的速度信息sub_ = nh.subscribe<nav_msgs::Odometry>("odom", 10, &TrajectoryRecorder::odometryCallback, this);// 发布轨迹信息pub_ = nh.advertise<geometry_msgs::PoseStamped>("trajectory", 10);}void odometryCallback(const nav_msgs::Odometry::ConstPtr& msg) {// 将速度信息转换为轨迹点geometry_msgs::PoseStamped pose;pose.header = msg->header;pose.pose = msg->pose.pose;trajectory_.push_back(pose);// 可以选择在这里发布轨迹点pub_.publish(pose);}// 可以添加一个方法来保存轨迹数据void saveTrajectory() {// 这里可以添加代码将trajectory_保存到文件}private:ros::Subscriber sub_;ros::Publisher pub_;std::vector<geometry_msgs::PoseStamped> trajectory_;
};} // namespace my_robot_trackerint main(int argc, char** argv) {ros::init(argc, argv, "tracker_node");my_robot_tracker::TrajectoryRecorder recorder;ros::spin();return 0;
}

接下来,你需要在 CMakeLists.txt 文件中添加编译指令:

cmake_minimum_required(VERSION 2.8.3)
project(my_robot_tracker)find_package(catkin REQUIRED COMPONENTSstd_msgsroscppnav_msgsgeometry_msgs
)include_directories(${catkin_INCLUDE_DIRS}
)add_executable(tracker_node src/tracker_node.cpp)
target_link_libraries(tracker_node ${catkin_LIBRARIES})

最后,你需要在 package.xml 文件中添加依赖:

<package><name>my_robot_tracker</name><version>0.0.0</version><description>A package for recording robot trajectory</description><maintainer email="your_email@example.com">your_name</maintainer><license>BSD</license><build_depend>roscpp</build_depend><build_depend>std_msgs</build_depend><build_depend>nav_msgs</build_depend><build_depend>geometry_msgs</build_depend><exec_depend>roscpp</exec_depend><exec_depend>std_msgs</exec_depend><exec_depend>nav_msgs</exec_depend><exec_depend>geometry_msgs</exec_depend>
</package>

确保你的工作空间是最新的,然后编译你的包:

cd ~/catkin_ws
catkin_make
source devel/setup.bash

现在,你可以运行你的节点:

rosrun my_robot_tracker tracker_node

这个简单的示例展示了如何创建一个记录机器人速度并将其转换成轨迹的类,并将其放置在一个自定义的命名空间 my_robot_tracker 中。你可以根据需要扩展这个类,添加更多的功能,比如保存轨迹到文件等。

2、分文件编写

要将代码分成两个文件,我们可以将类定义和其成员函数的实现放在一个头文件和一个源文件中,而将 main 函数放在另一个源文件中。以下是如何组织这些代码:

1. 头文件(trajectory_recorder.h)

#ifndef TRAJECTORY_RECORDER_H
#define TRAJECTORY_RECORDER_H#include <ros/ros.h>
#include <nav_msgs/Odometry.h>
#include <geometry_msgs/PoseStamped.h>
#include <vector>namespace my_robot_tracker {class TrajectoryRecorder {
public:TrajectoryRecorder();void odometryCallback(const nav_msgs::Odometry::ConstPtr& msg);void saveTrajectory();private:ros::Subscriber sub_;ros::Publisher pub_;std::vector<geometry_msgs::PoseStamped> trajectory_;
};} // namespace my_robot_tracker#endif // TRAJECTORY_RECORDER_H

2. 源文件(trajectory_recorder.cpp)

#include "trajectory_recorder.h"namespace my_robot_tracker {TrajectoryRecorder::TrajectoryRecorder() {// 初始化ROS节点ros::NodeHandle nh;// 订阅机器人的速度信息sub_ = nh.subscribe<nav_msgs::Odometry>("odom", 10, &TrajectoryRecorder::odometryCallback, this);// 发布轨迹信息pub_ = nh.advertise<geometry_msgs::PoseStamped>("trajectory", 10);
}void TrajectoryRecorder::odometryCallback(const nav_msgs::Odometry::ConstPtr& msg) {// 将速度信息转换为轨迹点geometry_msgs::PoseStamped pose;pose.header = msg->header;pose.pose = msg->pose.pose;trajectory_.push_back(pose);// 可以选择在这里发布轨迹点pub_.publish(pose);
}void TrajectoryRecorder::saveTrajectory() {// 这里可以添加代码将trajectory_保存到文件
}} // namespace my_robot_tracker

3. 主函数文件(main.cpp)

#include <ros/ros.h>
#include "trajectory_recorder.h"int main(int argc, char** argv) {ros::init(argc, argv, "tracker_node");my_robot_tracker::TrajectoryRecorder recorder;ros::spin();return 0;
}

更新CMakeLists.txt
确保你的 CMakeLists.txt 文件包含了新的文件:

cmake_minimum_required(VERSION 2.8.3)
project(my_robot_tracker)find_package(catkin REQUIRED COMPONENTSstd_msgsroscppnav_msgsgeometry_msgs
)include_directories(${catkin_INCLUDE_DIRS}
)add_executable(tracker_node src/main.cpp src/trajectory_recorder.cpp)
target_link_libraries(tracker_node ${catkin_LIBRARIES})

这样就将代码分成了三个文件:一个头文件 trajectory_recorder.h ,一个源文件 trajectory_recorder.cpp ,以及一个包含 main 函数的文件 main.cpp 。这种组织方式使得代码更加模块化,易于管理和维护。

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.rhkb.cn/news/464942.html

如若内容造成侵权/违法违规/事实不符,请联系长河编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

RK3568开发板静态IP地址配置

1. 连接SSH MYD-LR3568 开发板设置了静态 eth0:1 192.168.0.10 和 eth1:1 192.168.1.10&#xff0c;在没有串口时调试开发板&#xff0c;可以用工具 SSH 登陆到开发板。 首先需要用一根网线直连电脑和开发板&#xff0c;或者通过路由器连接到开发板&#xff0c;将电脑 IP 手动设…

MySQL45讲 第八讲 事务到底是隔离的还是不隔离的?

文章目录 MySQL45讲 第八讲 事务到底是隔离的还是不隔离的&#xff1f;MVCC 实现原理事务 ID 与数据版本一致性视图 总结 MySQL45讲 第八讲 事务到底是隔离的还是不隔离的&#xff1f; 在 MySQL 的事务处理中&#xff0c;事务隔离级别与数据一致性是至关重要的概念。可重复读隔…

【工具变量】中国制造2025试点城市数据集(2000-2023年)

数据简介&#xff1a;《中国制造2025》是中国ZF于2015年5月8日印发的一项战略规划&#xff0c;旨在加快制造业的转型升级&#xff0c;提升制造业的质量和效益&#xff0c;实现从制造大国向制造强国的转变。该规划是中国实施制造强国战略的第一个十年行动纲领&#xff0c;明确提…

任务中心全新升级,新增分享接口文档功能,MeterSphere开源持续测试工具v3.4版本发布

2024年11月5日&#xff0c;MeterSphere开源持续测试工具正式发布v3.4版本。 在这一版本中&#xff0c;系统设置方面&#xff0c;任务中心支持实时查看系统即时任务与系统后台任务&#xff1b;接口测试方面&#xff0c;新增接口文档分享功能、接口场景导入导出功能&#xff0c;…

CUDA下载和安装

CUDA下载和安装 前言下载安装后续添加参考链接 前言 由于我需要运行的代码与我当前的CUDA版本不兼容,所以我现在需要进行CUDA的更新,下载一个低版本的CUDA以匹配我的Pytorch 下载 CUDA下载地址:CUDA下载链接 选择适合自己的版本 由于我是要运行一个开源项目,我选择对应的CU…

Multimodal Reasoning with Multimodal Knowledge Graph

摘要 大型语言模型&#xff08;llm&#xff09;的多模态推理常常存在幻觉和llm中存在缺陷或过时的知识。一些方法试图通过使用文本知识图来缓解这些问题&#xff0c;但其单一的知识形态限制了全面的跨模态理解。本文提出了多模态推理与多模态知识图&#xff08;MR-MKG&#xf…

Git代码托管(三)可视化工具操作(1)

常见的可视化操作工具有 一、官方网页 如码云、gitlab&#xff0c;自带了常见的git操作。 以码云为例&#xff1a; 1、创建分支&#xff1a; 进入分支目录&#xff0c;点击 新建分支 按钮&#xff0c; 在弹出框中输入新分支名称&#xff0c;点击确定即可一键创建分支&…

go中Println和Printf的区别

Don’t worry , just coding! 内耗与overthinking只会削弱你的精力&#xff0c;虚度你的光阴&#xff0c;每天迈出一小步&#xff0c;回头时发现已经走了很远。 go中Println和Printf的区别 package mainimport ( "fmt" )//TIP To run your code, right-click the c…

项目审核系统 ---(连接数据库---项目模拟)

本章主要是查询方法和修改方法 编写查询方法&#xff0c;查询所有项目审核信息并返回查询结果&#xff0c;需实现分页功能&#xff0c;注意必要的异常处理。编写查询方法&#xff0c;根据项目编号查询指定项目的审核信息&#xff0c;注意必要的异常处理。编写修改方法&#xf…

(十三)JavaWeb后端开发——MySQL2

目录 1.DQL数据查询语言 1.1基本查询 1.2条件查询 where关键字 1.3分组查询 1.4排序查询 1.5分页查询 2.多表设计 3.多表查询——联查 4.多表查询——子查询​ 5.MySQL 事务 6.MySQL 索引 1.DQL数据查询语言 分为五大基本查询语法 1.1基本查询 -- 查询特定字段 s…

【STL栈和队列】:高效数据结构的应用秘籍

前言&#xff1a; C 标准模板库&#xff08;STL&#xff09;为我们提供了多种容器&#xff0c;其中 stack&#xff08;栈&#xff09;和 queue&#xff08;队列&#xff09;是非常常用的两种容器。 根据之前C语言实现的栈和队列&#xff0c;&#xff08;如有遗忘&#xff0c;…

LWIP通信协议UDP发送、接收源码解析

1.UDP发送函数比较简短&#xff0c;带操作系统和裸机一样。以下是udp_sendto源码解析&#xff1b; 2.LWIP源码UDP接收数据 2.1.UDP带操作系统接收数据&#xff0c;以下是源码解析&#xff1b; 2.2.UDP裸机接收数据&#xff0c;以下是源码解析

小菜家教平台:基于SpringBoot+Vue打造一站式学习管理系统

前言 现在已经学习了很多与Java相关的知识&#xff0c;但是迟迟没有进行一个完整的实践&#xff08;之前这个项目开发到一半&#xff0c;很多东西没学搁置了&#xff0c;同时原先的项目中也有很多的问题&#xff09;&#xff0c;所以现在准备从零开始做一个基于SpringBootVue的…

【优选算法 — 双指针】双指针小专题

和为 s 的两个数 和为s的两个数 题目描述 解法一&#xff1a;暴力枚举 暴力枚举&#xff0c;先固定一个数&#xff0c;然后让这个数和另一个数匹配相加&#xff0c; 如果当前的数 所有剩余的数 target&#xff0c;则返回这两个数&#xff0c;否则固定下一个数&#…

轻松理解操作系统 - 轻松了解 inode 是如何管理文件的

Linux 由于其开源、比较稳定等特点统治了服务端领域。也因此&#xff0c;学习Linux 系统相关知识在后端开发等岗位中变得越来越重要&#xff0c;甚至可以说是必不可少的。 因为它的广泛应用&#xff0c;所以在程序员的日常工作和面试中&#xff0c;它都是经常出现的。它的开源特…

Vue(JavaScript)读取csv表格并求某一列之和(大浮点数处理: decimal.js)

文章目录 想要读这个表格&#xff0c;并且求第二列所有价格的和方法一&#xff1a;通过添加文件输入元素上传csv完整&#xff08;正确&#xff09;代码之前的错误部分因为价格是小数&#xff0c;所以下面的代码出错。如果把parseFloat改成parseInt&#xff0c;那么求和没有意义…

微信小程序-事件总线

一.事件总线的概念和作用 事件总线是对发布-订阅模式的一种实现&#xff0c;是一种集中式事件处理机制&#xff0c;允许不同组件之间进行彼此通信&#xff0c;常用于两个非父子组件和兄弟组件之间的通讯。 在日常开发过程中&#xff0c;我们可以使用第三方的发布订阅 JS 包来实…

成都郝蓉宜恺文化传媒:引领大数据应用新篇章

在信息化浪潮汹涌的今天&#xff0c;大数据被誉为新时代的“石油”&#xff0c;正在以前所未有的速度改变着我们的生活和工作方式。成都郝蓉宜恺文化传媒&#xff0c;作为大数据领域的领军企业&#xff0c;始终站在创新的前沿&#xff0c;引领着大数据应用的新篇章。 作为大数…

qt QDropEvent详解

1、概述 QDropEvent是Qt框架中用于处理拖放释放事件的一个类。它允许开发者在用户界面中更好地管理和处理拖放操作&#xff0c;从而实现交互式和响应式的应用程序。QDropEvent类提供了处理拖放释放事件所需的方法和信号&#xff0c;使得开发者能够轻松地实现拖放功能&#xff…

Kotlin的内置函数

Kotlin 提供了丰富的内置函数&#xff0c;它们极大简化了日常开发工作。常见内置函数包括 标准库函数&#xff08;let、apply、run 等&#xff09;&#xff0c;用于提高代码的简洁性和可读性。下面我们详细介绍这些函数的功能、用法以及它们之间的区别。 1. let 函数 let 通常…