ros --- c++和python 中 launch和yaml使用

2024-06-19 09:32
文章标签 python c++ 使用 launch ros yaml

本文主要是介绍ros --- c++和python 中 launch和yaml使用,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

1. Launch使用

ros单个工程的运行可以使用rosrun,但是做项目不可能只有一个或几个工程,当需要大量的工程配合运行时launch就应运而生了
关于launch的说明可以参考ROS入门之——浅谈launch
这里重点说明几点:

  1. launch文件需要放在某个package目录下,最好放在最主要的package目录下,醒目
  2. launch文件是可以跨包的,不要因为roslaunch test_pkg test.launch运行在test_pkg下而认为只能执行test_pkg下的节点,只要配置好对应的包名,节点,和执行文件即可
  3. launch文件后缀必须是.launch

launch文件示例:

<launch>  <param name="version" value="1.0.1"/><arg name="arg1" default="0.01"/><node pkg="can_pkg" name="car_control_node" type="car_control_node"/><node pkg="can_pkg" name="radar_parsing_node" type="radar_parsing_node" output="screen"/><node pkg="aeb_pkg" name="aeb" type="aeb" output="log"/><node pkg="ssd_pkg" name="ssd" type="ssd.py" ><param name="rosRate" type="double" value="$(arg arg1)"/></node><group ns="gains"><param name="P" type="double" value="1.0" /><param name="I" type="double" value="2.0" /><param name="D" type="double" value="3.0" />      </group>
</launch>
  1. type是执行文件的名称,如果是用Python编写的就填写xxx.py,如果是C++就写编译生成的可执行文件名
  2. output 设置成screen是输出到屏幕,默认是输出到日志文件,日志保存在.ros/log目录下
  3. respawn和required, 关于节点运行出错的处理,两个只能选一种
  4. arg和param配合通过变量控制参数值,可以在执行launch时给定参数值,运行命令没有给定时使用默认值default设置的值
roslaunch ssd_pkg merge.launch arg1:=0.15
  1. 参数的增删改查
  • C++ ,注意使用对应的参数类型

内部参数使用~ :比如rosRate为ssd_pkg的内部参数,其他包不能使用
全局参数加/ :version为全局参数,所有包可以加载
当然内部参数可以使用全路径方式指定:/ssd_pkg/rosRate

  ros::init(argc, argv, "path_show");ros::NodeHandle n("~");	//默认获取内部参数double rate;std_msgs::String version;//参数的获取n.getParam("/version", version);	// 全局参数,加/n.getParam("rosRate", rate);//或ros::param::get("/ssd_pkg/rosRate", rate);// 获取不到指定的param,可以给一个默认值n.param("rosRate", rate, 1.5); //除了获取参数外还能设置,检查,删除参数ros::param::set("rosRate", 1.5);n.setParam("rosRate",1.5);bool has = ros::param::has("rosRate");has = n.hasParam("rosRate");bool del= n.deleteParam("rosRate");del= ros::param::del("rosRate");
  • python获取
    version = rospy.get_param(‘/version’) # 获取全局参数带/
    rete = rospy.get_param(‘~rosRate’)# 获取私有命名空间参数需要带~
if rospy.has_param('gains'):gains = rospy.get_param('gains')p, i, d = gains['P'], gains['I'], gains['D']

2. Yaml的使用

YAML(发音 /ˈjæməl/)是一个可读性高,用来表达数据序列化的格式,
其命名来历很有意思:

  • 有人说是 “YAML Ain’t a Markup Language”(YAML不是一种标记语言)的递归缩写
  • 在开发的这种语言时,YAML 的意思其实是:“Yet Another Markup Language”(仍是一种标记语言),但为了强调这种语言以数据做为中心,而不是以标记语言为重点,而用反向缩略语重命名

其语法可以参考YAML文件简介

yaml配合launch使用很方便

这里拿个小例子说明:

  • config.yaml , 文件放在了test_pkg的同级目录,

注意
1.yaml使用空格设置层级,多少个空格没关系,保持一致即可,不能使用table
2. -开头组成列表(当然也可以使用[]),字典使用{}加键值对
3. 类型会自动识别字符串和数字,如果要指定为字符串需要用双引号
4. 重点说明:yaml缩进不能使用table

python例子
merge_area: # 对象car: {left: 0, top: 0.5, right: 1, bottom: 1.25}    # 字典的使用bus: {left: 0.125, top: 0.5, right: 0.875, bottom: 1.25}person: {left: -0.25, top: 0.75, right: 1.25, bottom: 1.25}
image_path: /home/fly/catkin_ws/image/ # 可以不用带引号
pi: 3.14 # 默认为数字,若要定义为字符串需要加双引号
PID:	# 列表的使用,等同于 [{'P': 1.0}, {'I': 2.0}, {'D': 3.0}]- P: 1.0- I: 2.0- D: 3.0

找到test_pkg同级目录的config.yaml然后加载它

<launch><node pkg="test_pkg" name="test" type="test.py" respawn="true" output="screen"> <rosparam file="$(find test_pkg)../config.yaml" command="load"/></node>
</launch>

获取配置的属性值

#!/usr/bin/env python3
#coding=utf-8import rospydef get_param():print("start test package .... ")area = rospy.get_param('~merge_area')image_path = rospy.get_param('~image_path')pid = rospy.get_param('~PID')print(area)print(image_path)print(pid)if __name__ == '__main__':try:rospy.init_node('test', anonymous=True)get_param()except rospy.ROSInterruptException:print('ROSInterruptException')pass

打印输出

start test package ....
{'person': {'top': 0.75, 'right': 1.25, 'bottom': 1.25, 'left': -0.25}, 'bus': {'top': 0.5, 'right': 0.875, 'left': 0.125, 'bottom': 1.25}, 'car': {'top': 0.5, 'left': 0, 'right': 1, 'bottom': 1.25}}
/home/fly/catkin_ws/image/
[{'P': 1.0}, {'I': 2.0}, {'D': 3.0}]
C++例子

利用ROS自带的XmlRpc::XmlRpcValue实现一维数组或者二位数组等类似json数据的读取

yaml文件

# yaml文件
scanners: 
- {pub_topic: "scan_head", frame_id: "laser_scanner_link_head",server_ip: "192.168.167.100",server_port: 2111}
- {pub_topic: "scan_middle",frame_id: "laser_scanner_link_middle",server_ip: "192.168.167.101",server_port: 2111}
- {pub_topic: "scan_tail",frame_id: "laser_scanner_link_tail",server_ip: "192.168.167.102",server_port: 2111}merge_area: car: {left: 0, top: 0.5, right: 1.0, bottom: 1.25}bus: {left: 0.125, top: 0.5, right: 0.875, bottom: 1.25}person: {left: -0.25, top: 0.75, right: 1.25, bottom: 1.25}num_list: [37.783, 1.414, 3.14, 0.618]

C++读取代码

#include <ros/ros.h>
#include <std_msgs/String.h>
#include <string>using namespace std;int main(int argc, char **argv) {ros::init(argc, argv, "path_show");ros::NodeHandle nh("~");//字典数组的解析XmlRpc::XmlRpcValue params;nh.getParam("scanners", params);for(size_t i = 0; i<params.size(); ++i){const std::string& server_ip = params[i]["server_ip"];const std::string& frame_id = params[i]["frame_id"];const std::string& pub_topic = params[i]["pub_topic"];const int& server_port  = params[i]["server_port"];printf("ip:%s, id:%s, topic:%s, port:%d \r\n", server_ip.c_str(), frame_id.c_str(), pub_topic.c_str(), server_port);}//数组写入向量XmlRpc::XmlRpcValue nums;nh.getParam("num_list", nums);std::vector<double> num_list;for (size_t i = 0; i < nums.size(); ++i) {XmlRpc::XmlRpcValue tmp_value = nums[i];if(tmp_value.getType() == XmlRpc::XmlRpcValue::TypeDouble)num_list.push_back(double(tmp_value));printf("get one num: %f\r\n", double(tmp_value));}//字典读取,注意类型对应XmlRpc::XmlRpcValue area;nh.getParam("merge_area", area);XmlRpc::XmlRpcValue car= area["car"];printf("car_area = top: %f, left: %d, bottom: %f, right: %f\r\n", double(car["top"]), int(car["left"]), double(car["bottom"]), double(car["right"]));}

注意类型的转换,需要注意一一对应,如果不对应,就会报错,(如:int不能使用double强转)
报错信息:terminate called after throwing an instance of ‘XmlRpc::XmlRpcException’

输出信息

ip:192.168.167.100, id:laser_scanner_link_head, topic:scan_head, port:2111
ip:192.168.167.101, id:laser_scanner_link_middle, topic:scan_middle, port:2111
ip:192.168.167.102, id:laser_scanner_link_tail, topic:scan_tail, port:2111
get one num: 37.783000
get one num: 1.414000
get one num: 3.140000
get one num: 0.618000
car_area = top: 0.500000, left: 0, bottom: 1.250000, right: 1.000000

这篇关于ros --- c++和python 中 launch和yaml使用的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/1074643

相关文章

Python调用Orator ORM进行数据库操作

《Python调用OratorORM进行数据库操作》OratorORM是一个功能丰富且灵活的PythonORM库,旨在简化数据库操作,它支持多种数据库并提供了简洁且直观的API,下面我们就... 目录Orator ORM 主要特点安装使用示例总结Orator ORM 是一个功能丰富且灵活的 python O

Java中String字符串使用避坑指南

《Java中String字符串使用避坑指南》Java中的String字符串是我们日常编程中用得最多的类之一,看似简单的String使用,却隐藏着不少“坑”,如果不注意,可能会导致性能问题、意外的错误容... 目录8个避坑点如下:1. 字符串的不可变性:每次修改都创建新对象2. 使用 == 比较字符串,陷阱满

Python使用国内镜像加速pip安装的方法讲解

《Python使用国内镜像加速pip安装的方法讲解》在Python开发中,pip是一个非常重要的工具,用于安装和管理Python的第三方库,然而,在国内使用pip安装依赖时,往往会因为网络问题而导致速... 目录一、pip 工具简介1. 什么是 pip?2. 什么是 -i 参数?二、国内镜像源的选择三、如何

使用C++实现链表元素的反转

《使用C++实现链表元素的反转》反转链表是链表操作中一个经典的问题,也是面试中常见的考题,本文将从思路到实现一步步地讲解如何实现链表的反转,帮助初学者理解这一操作,我们将使用C++代码演示具体实现,同... 目录问题定义思路分析代码实现带头节点的链表代码讲解其他实现方式时间和空间复杂度分析总结问题定义给定

Linux使用nload监控网络流量的方法

《Linux使用nload监控网络流量的方法》Linux中的nload命令是一个用于实时监控网络流量的工具,它提供了传入和传出流量的可视化表示,帮助用户一目了然地了解网络活动,本文给大家介绍了Linu... 目录简介安装示例用法基础用法指定网络接口限制显示特定流量类型指定刷新率设置流量速率的显示单位监控多个

JavaScript中的reduce方法执行过程、使用场景及进阶用法

《JavaScript中的reduce方法执行过程、使用场景及进阶用法》:本文主要介绍JavaScript中的reduce方法执行过程、使用场景及进阶用法的相关资料,reduce是JavaScri... 目录1. 什么是reduce2. reduce语法2.1 语法2.2 参数说明3. reduce执行过程

如何使用Java实现请求deepseek

《如何使用Java实现请求deepseek》这篇文章主要为大家详细介绍了如何使用Java实现请求deepseek功能,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一下... 目录1.deepseek的api创建2.Java实现请求deepseek2.1 pom文件2.2 json转化文件2.2

python使用fastapi实现多语言国际化的操作指南

《python使用fastapi实现多语言国际化的操作指南》本文介绍了使用Python和FastAPI实现多语言国际化的操作指南,包括多语言架构技术栈、翻译管理、前端本地化、语言切换机制以及常见陷阱和... 目录多语言国际化实现指南项目多语言架构技术栈目录结构翻译工作流1. 翻译数据存储2. 翻译生成脚本

C++初始化数组的几种常见方法(简单易懂)

《C++初始化数组的几种常见方法(简单易懂)》本文介绍了C++中数组的初始化方法,包括一维数组和二维数组的初始化,以及用new动态初始化数组,在C++11及以上版本中,还提供了使用std::array... 目录1、初始化一维数组1.1、使用列表初始化(推荐方式)1.2、初始化部分列表1.3、使用std::

C++ Primer 多维数组的使用

《C++Primer多维数组的使用》本文主要介绍了多维数组在C++语言中的定义、初始化、下标引用以及使用范围for语句处理多维数组的方法,具有一定的参考价值,感兴趣的可以了解一下... 目录多维数组多维数组的初始化多维数组的下标引用使用范围for语句处理多维数组指针和多维数组多维数组严格来说,C++语言没