LoginSignup
0
0

More than 1 year has passed since last update.

@Yuya-Shimizu(清水 優椰)

ROSの勉強　第48弾：Xacroチュートリアルのまとめ

Last updated at Posted at 2023-03-12

#プログラミング ROS< Xacroチュートリアルのまとめ >

はじめに

ROS(Robot Operating System)をさらに扱えるようになることが目的である．その第48弾として，「Xacroチュートリアルのまとめ」を扱う．

環境

Docker環境（VScode + Windows10）
Dockerfile
Dockerfile
FROM osrf/ros:noetic-desktop-full

WORKDIR /root/

ENV DISPLAY host.docker.internal:0.0

RUN apt-get update -y && apt-get upgrade -y
RUN apt-get install x11-apps -y
RUN echo "source /opt/ros/noetic/setup.sh" >> .bashrc
RUN mkdir -p catkin_ws/src
RUN cd catkin_ws/src && . /opt/ros/noetic/setup.sh && catkin_init_workspace
RUN cd && cd catkin_ws && . /opt/ros/noetic/setup.sh && catkin_make
RUN echo "source ./catkin_ws/devel/setup.bash" >> .bashrc

RUN apt-get update -y && apt-get upgrade -y && apt-get install git -y
devcontainer.json
devcontainer.json
// For format details, see https://aka.ms/devcontainer.json. For config options, see the README at:
// https://github.com/microsoft/vscode-dev-containers/tree/v0.224.3/containers/docker-existing-dockerfile
{
	"name": "Existing Dockerfile",

	// Sets the run context to one level up instead of the .devcontainer folder.
	"context": "..",

	// Update the 'dockerFile' property if you aren't using the standard 'Dockerfile' filename.
	"dockerFile": "../Dockerfile",

	// Set *default* container specific settings.json values on container create.
	"settings": {},
	
	// Add the IDs of extensions you want installed when the container is created.
	"extensions": [
		"ms-python.python",
		"ms-python.vscode-pylance",
		"ms-iot.vscode-ros"
	],

	"workspaceFolder": "/root/",

	"mounts": [
		"source=${localWorkspaceFolder}/share,target=/root/share,type=bind",
	],
	// // Use 'forwardPorts' to make a list of ports inside the container available locally.
	// // "appPort": ["11411:11411"],

	// // Uncomment the next line to run commands after the container is created - for example installing curl.
	// // "postCreateCommand": "apt-get update && apt-get install -y curl",

	// // Uncomment when using a ptrace-based debugger like C++, Go, and Rust
	"runArgs": ["--gpus=all"],

	// Uncomment to use the Docker CLI from inside the container. See https://aka.ms/vscode-remote/samples/docker-from-docker.
	// "mounts": ["source=../src/,target=/root/src,type=bind"],
	// "mounts": [ "source=../src,target=/root/src,type=bind" ],

	// Uncomment to connect as a non-root user if you've added one. See https://aka.ms/vscode-remote/containers/non-root.
	// "remoteUser": "vscode"
}

参考

コンピュータ
デバイス MSI
プロセッサ Intel(R) Core(TM) i5-7300HQ CPU @ 2.50GHz 2.50GHz
実装RAM 16.0 GB (15.9 GB 使用可能)
OS Windows (Windows 10 Home, バージョン：22H2)
ROS
Distribution noetic

Xacroの基本

Xacroファイルのトップに必要

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

urdfからxacro（不変から可変）

不変＜urdf＞ 
<link name="base_link">
    <visual>
      <geometry>
        <cylinder radius="0.2" length="0.6"/>
      </geometry>
      <material name="blue"/>
    </visual>
    <collision>
      <geometry>
        <cylinder radius="0.2" length="0.6"/>
      </geometry>
    </collision>
  </link>
可変＜xacro＞ 
<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>

<xacro:property>タグにより変数名とその値を宣言できる

${}の使い方

<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" />

計算結果はすべてfloatとなる。そのため、

<link name="${5/6}"/>

は

<link name="0.833333333333"/>

となる。

シンプルなマクロ

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

マクロは関数的なものである。
<xacro:default_origin />で関数を実行する。

パラメータ（引数）付きマクロ

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

関数を使うときには、引数を指定できる。
<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>

<xacro:insert_block name="shape" />
により、関数を使うときにブロックごと挿入することができる。

作成例

同じ構造を持つ足を２本生成

leg_macro.xacro＜xacro＞
leg_macro.xacro
<?xml version="1.0"?>
<robot xmlns:xacro="http://ros.org/wiki/xacro">

    <xacro:macro name="leg" params="prefix reflect width">
        <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>
</robot>
material_colors.xacro＜xacro＞
material_colors.xacro
<?xml version="1.0"?>
<robot xmlns:xacro="http://ros.org/wiki/xacro">

<!-- Define Material Colors -->
<material name="white">
    <color rgba="1.0 1.0 1.0 1.0"/>
</material>

<material name="red">
    <color rgba="1.0 0.0 0.0 1.0"/>
</material>

<material name="green">
    <color rgba="0.0 1.0 0.0 1.0"/>
</material>

<material name="blue">
    <color rgba="0.0 0.0 1.0 1.0"/>
</material>

<material name="yellow">
    <color rgba="1.0 1.0 0.0 1.0"/>
</material>

<material name="cyan">
    <color rgba="0.0 1.0 1.0 1.0"/>
</material>

<material name="purple">
    <color rgba="1.0 0.0 1.0 1.0"/>
</material>

<material name="black">
    <color rgba="0.0 0.0 0.0 1.0"/>
</material>

</robot>
test.xacro＜xacro＞
test.xacro
<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="My_Robot_Name">
	<xacro:include filename="$(find urdf_test)/urdf/xacro_test/material_colors.xacro" />
	<xacro:include filename="$(find urdf_test)/urdf/xacro_test/leg_macro.xacro" />

	<xacro:property name="leglen" value="0.6" />
	<xacro:property name="width" value="0.2" />

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

	<xacro:leg prefix="right" reflect="1" width="${width}"/>
	<xacro:leg prefix="left" reflect="-1" width="${width}"/>

</robot>

マクロテンプレート

これをテンプレートとして抑えておけば，様々なマクロを容易に作成できる．

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

<xacro:macro name="macro_name" params="name mass length">

</xacro:macro>

</robot>

xacro to urdf

ターミナル上で以下のコマンドにより，XacroをURDFに変換することができる．
なお，URDFの名前は任意である．

ターミナル上で実行する
xacro test.xacro > test.urdf

xacroをそのまま（ロード時に変換）

URDFに変換せずとも，そのままXacroファイルをロードすることができる．
launchファイルのrobot_descriptionのところを以下のようにする．

<param name="robot_description"
  command="xacro --inorder '$(find pr2_description)/robots/pr2.urdf.xacro'" />

注意：直接Xacroから構築するためロードには少し時間がかかる

感想

前回のURDFをXacroファイルで体系的にまとめていく前に，Xacroのチュートリアルについてまとめてみた．マクロのやマクロのインポートなどを駆使すればいい感じにまとめていけそうな感じがする．
次回こそ，前回のURDFをきれいにしていくこととする．

参考文献

0
0
0

Register as a new user and use Qiita more conveniently

  1. You get articles that match your needs
  2. You can efficiently read back useful information
  3. You can use dark theme
What you can do with signing up
Sign upLogin
0
0