ROS 2边学边练(47)-- 利用Xacro精简代码

2024-05-13 21:20

本文主要是介绍ROS 2边学边练(47)-- 利用Xacro精简代码,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

前言

        Xacro(XML Macro)是ROS(Robot Operating System)中用于处理URDF(Unified Robot Description Format)文件的一个宏处理工具。它允许你在URDF文件中定义和使用宏,这样可以减少重复的代码,并使得机器人描述更加清晰和易于管理。通过xacro,你可以定义变量、包含其他文件、执行条件语句等,这些功能都使得编写和维护复杂的机器人模型变得更加容易。

        到目前为止,如果你正在家里按照这些步骤设计自己的机器人,你可能会对做各种数学计算以获取能够正确解析的非常简单的机器人描述感到厌倦。幸运的是,你可以使用xacro包来简化这个过程。它提供了三个非常有用的功能。

  • 常量
  • 简单数学运算

        在URDF中利用Xacro,会使人更易读懂及维护。

动动手

使用Xacro

        xacro的典型用法如下:

$xacro model.xacro > model.urdf

        在launch文件里面使用xacro,我们需要使用Command替代方式给robot_state_publisher传参。

path_to_urdf = get_package_share_path('turtlebot3_description') / 'urdf' / 'turtlebot3_burger.urdf'
robot_state_publisher_node = launch_ros.actions.Node(package='robot_state_publisher',executable='robot_state_publisher',parameters=[{'robot_description': ParameterValue(Command(['xacro ', str(path_to_urdf)]), value_type=str)}]
)

        一种加载机器人模型(自动加载xacro/urdf)更简单的方式是使用urdf_launch功能包。

from launch import LaunchDescription
from launch.actions import IncludeLaunchDescription
from launch.substitutions import PathJoinSubstitution
from launch_ros.substitutions import FindPackageSharedef generate_launch_description():ld = LaunchDescription()ld.add_action(IncludeLaunchDescription(PathJoinSubstitution([FindPackageShare('urdf_launch'), 'launch', 'display.launch.py']),launch_arguments={'urdf_package': 'turtlebot3_description','urdf_package_path': PathJoinSubstitution(['urdf', 'turtlebot3_burger.urdf'])}.items()))return ld

        在URDF文件的顶部,必须指定一个命名空间才能正确解析文件。例如,以下是有效xacro文件的前两行:

<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="firefighter">

常量

        我们下面看一段之前R2D2机器人的base_link的urdf定义。

<link name="base_link"><visual><geometry><cylinder length="0.6" radius="0.2"/></geometry><material name="blue"/></visual><collision><geometry><cylinder length="0.6" radius="0.2"/></geometry></collision>
</link>

        可以看到对于同样值的length和radius写了两次(虽然是在不同的属性标签里),如果一个文件里有多处同样的定义,再如果需要修改,那么就会重复修改多次,很烦也容易有遗漏。那有没有什么好的办法可以轻松科学一点呢?

        那就是常量,我们可以将同样属性内容定义为一个常量,需要用到的对方引用此常量即可,来看看利用常量方式修改后的代码吧。

<xacro:property name="width" value="0.2" />
<xacro:property name="bodylen" value="0.6" />
<link name="base_link"><visual><geometry><cylinder radius="${width}" length="${bodylen}"/></geometry><material name="blue"/></visual><collision><geometry><cylinder radius="${width}" length="${bodylen}"/></geometry></collision>
</link>
  • 常量可以定义在xml文件的任何位置(不过是引用之前之后),一般建议放在文件的顶部为妥。
  • 在引用常量值时,利用美元符号与花括号${constant}。

        常量还有一种用法,拼接字符串,如下:

<xacro:property name=”robotname” value=”marvin” />
<link name=”${robotname}s_leg” />

等效于

<link name=”marvins_leg” />

数学运算

        在${...}里面可以支持加减乘除(+、-、*、/)的写法,如下:

<cylinder radius="${wheeldiam/2}" length="0.1"/>
<origin xyz="${reflect*(width+.02)} 0 0.25" />

同时,还可以支持如sin、cos等这样的运算函数。

        以下是xacro包中最大、最有用的组件。

简单宏

        先来看一个简单无用的宏。

<xacro:macro name="default_origin"><origin xyz="0 0 0" rpy="0 0 0"/>
</xacro:macro>
<xacro:default_origin />

等效于

<origin rpy="0 0 0" xyz="0 0 0"/>

        为什么上面的宏没意义?因为一般如果一个joint或link没定义原点,默认值就是0,与上面宏定义的等效,是不是多此一举。

关于宏有以下几个注意点:

  • 从技术上讲,名称不是必需的元素,但您需要指定它才能使用它。
  • <xacro:$NAME/>的每个实例都替换为xacro:宏标记的内容。
  • 不同属性定义的宏顺序不同不影响实际的xml生成文件。
  • 如果找不到具有指定名称的xacro,它将不会展开,也不会生成错误。
参数化宏

        我们也可以参数化宏,使它们不会每次都生成完全相同的文本。当与数学功能相结合时,这将更加强大。

        先来看一个R2D2机器人中简单宏的使用。

<xacro:macro name="default_inertial" params="mass"><inertial><mass value="${mass}" /><inertia ixx="1e-3" ixy="0.0" ixz="0.0"iyy="1e-3" iyz="0.0"izz="1e-3" /></inertial>
</xacro:macro>

        上述代码定义了一个名为default_inertial的宏,附带一个叫mass的参数(当有多个参数时用空格分开),当调用此宏时,可以像下面这样:

<xacro:default_inertial mass="10"/>

        也可以使用整个块作为参数。

<xacro:macro name="blue_shape" params="name *shape"><link name="${name}"><visual><geometry><xacro:insert_block name="shape" /></geometry><material name="blue"/></visual><collision><geometry><xacro:insert_block name="shape" /></geometry></collision></link>
</xacro:macro><xacro:blue_shape name="base_link"><cylinder radius=".42" length=".01" />
</xacro:blue_shape>
  • 若要指定块参数,请在其参数名称前包含一个星号*。 
  • 可以使用insert_block命令插入块。
  • 根据需要可以多次插入块。
实际使用

        xacro语言在允许我们做什么方面相当灵活。除了上面列出的默认惯性宏外,以下是在R2D2模型中使用xacro的一些有用方法。

        我们通过下面的命令来瞅瞅通过xacro文件生成的模型:

$ros2 launch urdf_tutorial display.launch.py model:=urdf/08-macroed.urdf.xacro

 

腿的宏

        通常情况,我们希望在不同的位置创建多个外观相似的对象。可以使用宏和一些简单的数学来减少必须编写的代码量,就像我们对R2的两条腿所做的那样。

<xacro:macro name="leg" params="prefix reflect"><link name="${prefix}_leg"><visual><geometry><box size="${leglen} 0.1 0.2"/></geometry><origin xyz="0 0 -${leglen/2}" rpy="0 ${pi/2} 0"/><material name="white"/></visual><collision><geometry><box size="${leglen} 0.1 0.2"/></geometry><origin xyz="0 0 -${leglen/2}" rpy="0 ${pi/2} 0"/></collision><xacro:default_inertial mass="10"/></link><joint name="base_to_${prefix}_leg" type="fixed"><parent link="base_link"/><child link="${prefix}_leg"/><origin xyz="0 ${reflect*(width+.02)} 0.25" /></joint><!-- A bunch of stuff cut -->
</xacro:macro>
<xacro:leg prefix="right" reflect="1" />
<xacro:leg prefix="left" reflect="-1" />
  • 常见技巧1:使用名称前缀获得两个名称相似的对象。
  • 常见技巧2:使用数学计算关节原点。在更改机器人大小的情况下,通过一些数学方法更改特性以计算关节偏移将省去很多麻烦。
  • 常见技巧3:使用反射参数,并将其设置为1或-1。看看我们如何使用reflect参数将腿放在身体两侧的(base_to_${prefix}_leg origin标签属性中)。

本篇完。

这篇关于ROS 2边学边练(47)-- 利用Xacro精简代码的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



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

相关文章

活用c4d官方开发文档查询代码

当你问AI助手比如豆包,如何用python禁止掉xpresso标签时候,它会提示到 这时候要用到两个东西。https://developers.maxon.net/论坛搜索和开发文档 比如这里我就在官方找到正确的id描述 然后我就把参数标签换过来

poj 1258 Agri-Net(最小生成树模板代码)

感觉用这题来当模板更适合。 题意就是给你邻接矩阵求最小生成树啦。~ prim代码:效率很高。172k...0ms。 #include<stdio.h>#include<algorithm>using namespace std;const int MaxN = 101;const int INF = 0x3f3f3f3f;int g[MaxN][MaxN];int n

计算机毕业设计 大学志愿填报系统 Java+SpringBoot+Vue 前后端分离 文档报告 代码讲解 安装调试

🍊作者:计算机编程-吉哥 🍊简介:专业从事JavaWeb程序开发,微信小程序开发,定制化项目、 源码、代码讲解、文档撰写、ppt制作。做自己喜欢的事,生活就是快乐的。 🍊心愿:点赞 👍 收藏 ⭐评论 📝 🍅 文末获取源码联系 👇🏻 精彩专栏推荐订阅 👇🏻 不然下次找不到哟~Java毕业设计项目~热门选题推荐《1000套》 目录 1.技术选型 2.开发工具 3.功能

Codeforces Beta Round #47 C凸包 (最终写法)

题意慢慢看。 typedef long long LL ;int cmp(double x){if(fabs(x) < 1e-8) return 0 ;return x > 0 ? 1 : -1 ;}struct point{double x , y ;point(){}point(double _x , double _y):x(_x) , y(_y){}point op

代码随想录冲冲冲 Day39 动态规划Part7

198. 打家劫舍 dp数组的意义是在第i位的时候偷的最大钱数是多少 如果nums的size为0 总价值当然就是0 如果nums的size为1 总价值是nums[0] 遍历顺序就是从小到大遍历 之后是递推公式 对于dp[i]的最大价值来说有两种可能 1.偷第i个 那么最大价值就是dp[i-2]+nums[i] 2.不偷第i个 那么价值就是dp[i-1] 之后取这两个的最大值就是d

pip-tools:打造可重复、可控的 Python 开发环境,解决依赖关系,让代码更稳定

在 Python 开发中,管理依赖关系是一项繁琐且容易出错的任务。手动更新依赖版本、处理冲突、确保一致性等等,都可能让开发者感到头疼。而 pip-tools 为开发者提供了一套稳定可靠的解决方案。 什么是 pip-tools? pip-tools 是一组命令行工具,旨在简化 Python 依赖关系的管理,确保项目环境的稳定性和可重复性。它主要包含两个核心工具:pip-compile 和 pip

D4代码AC集

贪心问题解决的步骤: (局部贪心能导致全局贪心)    1.确定贪心策略    2.验证贪心策略是否正确 排队接水 #include<bits/stdc++.h>using namespace std;int main(){int w,n,a[32000];cin>>w>>n;for(int i=1;i<=n;i++){cin>>a[i];}sort(a+1,a+n+1);int i=1

html css jquery选项卡 代码练习小项目

在学习 html 和 css jquery 结合使用的时候 做好是能尝试做一些简单的小功能,来提高自己的 逻辑能力,熟悉代码的编写语法 下面分享一段代码 使用html css jquery选项卡 代码练习 <div class="box"><dl class="tab"><dd class="active">手机</dd><dd>家电</dd><dd>服装</dd><dd>数码</dd><dd

生信代码入门:从零开始掌握生物信息学编程技能

少走弯路,高效分析;了解生信云,访问 【生信圆桌x生信专用云服务器】 : www.tebteb.cc 介绍 生物信息学是一个高度跨学科的领域,结合了生物学、计算机科学和统计学。随着高通量测序技术的发展,海量的生物数据需要通过编程来进行处理和分析。因此,掌握生信编程技能,成为每一个生物信息学研究者的必备能力。 生信代码入门,旨在帮助初学者从零开始学习生物信息学中的编程基础。通过学习常用

husky 工具配置代码检查工作流:提交代码至仓库前做代码检查

提示:这篇博客以我前两篇博客作为先修知识,请大家先去看看我前两篇博客 博客指路:前端 ESlint 代码规范及修复代码规范错误-CSDN博客前端 Vue3 项目开发—— ESLint & prettier 配置代码风格-CSDN博客 husky 工具配置代码检查工作流的作用 在工作中,我们经常需要将写好的代码提交至代码仓库 但是由于程序员疏忽而将不规范的代码提交至仓库,显然是不合理的 所