機体をカスタマイズ
機体のSDFは、リンク、形状、質量、慣性、ジョイント、センサー、プラグインを定義します。選択した機体から出力したファイルを使うと、実行環境に合う接続を維持できます。
ダウンロードして編集・適用する
- ワークスペースで地形と機体を選び、開始前の確認画面を開きます。
- SDFファイルを編集から機体SDFをダウンロードを選びます。内蔵プロファイルは、先に生成済みリビジョンとして保存されます。
model.sdfのコピーを編集します。名前、リンク構造、プラグインの識別情報、素材パス、トピックを維持してください。- 編集した機体SDFをアップロードを選びます。検証後に新しいリビジョンが保存・選択され、元の機体も残ります。
- ワールドを開始し、静止状態を確認してから動かします。ファイルを保存しても、実行中のワールドには反映されません。
生成SDFの編集では、ビルダーで選んだ構造を維持します。センサーの追加・削除、制御モードやプロバイダーの変更はコピーを編集で行います。ネイティブプラグインはエンジンにインストールされている必要があり、SDFのアップロードではソフトウェアを導入できません。
モデルを節ごとに読む
| 節 | 意味と編集方法 |
|---|---|
model / pose |
モデルの基準位置・姿勢。ワークスペースは選択した地理位置に機体を配置します。 |
link / pose |
親に対するリンクの座標系。移動はm、ロール・ピッチ・ヨーはradです。 |
inertial / mass, pose |
質量(kg)と重心座標系。実際の寸法と整合させます。 |
inertia |
慣性テンソルの独立した6成分(kg·m²)。CADや実測質量分布を使います。正定値でないものや物理的に不整合な値は拒否されます。 |
visual / geometry |
表示形状とメッシュの倍率。変更しても衝突形状や質量は自動で変わりません。 |
collision / geometry |
接触計算に使う形状。船体に合う単純な閉じた形状を推奨します。 |
joint / pose / axis |
ジョイントの位置と軸方向。制御接続を保つため、ジョイント名と親子リンク名を維持します。 |
| 流体力・浮力プラグイン | 排水量、付加質量、抗力。海洋動力学と描画で符号の規約を確認します。 |
| 推進・制御プラグイン | 軸、係数、制御チャネル。形状変更後は低速で応答を確認します。 |
sensorと関連プラグイン |
取付位置、周波数、光学、音響、ノイズ。センサーをカスタマイズを参照してください。 |
テンプレート構造とセンサーの許容範囲内で、数値と真偽値を編集できます。開始前の確認画面からのアップロード上限は1 MBです。失敗した場合は表示されたSDF項目を修正して再試行します。
完全な例にはインストール済みモデルの実際の値を掲載していますが、実機に共通する校正値ではありません。Linuxエンジンの出力なので、macOSなどではそのホストの出力を使い、メッシュを含むZIPも保管してください。プラグインライブラリはインストールしたエンジンに合わせます。
WAM-Vの完全なSDF
WAM-V model.sdfをダウンロード。前方・下向きカメラ、DVL、2D LiDAR、Autopilot、GNSSを有効にした例です。ほかの対応オプションは無効なコメント例として含まれます。
wamv.sdf
<?xml version='1.0' encoding='utf-8'?>
<sdf xmlns:gz="http://gazebosim.org" version="1.7">
<!--
モデルの構成です。linkで剛体、jointで剛体間の接続を定義し、pluginでシミュレーション機能を追加します。名前はエクスポートした制御設定と一致させてください。
-->
<model name="wamv">
<!--
エクスポートした機体設定です。このコメントの後に有効なモデルが続きます。センサーとプロバイダーは機体エディターで選び、トピックとワールドシステムを一致させてください。取り付け範囲:位置±10 m、回転±2π rad。recipe.json:
{
"control_mode": "autopilot",
"gnss": true,
"schema_version": 1,
"sensors": [
"camera",
"camera_down",
"dvl",
"lidar_2d"
],
"settings": {
"camera": {
"height": 480,
"horizontal_fov": 1.4,
"pose": [
1.5,
0.0,
0.8,
0.0,
0.0,
0.0
],
"update_rate": 5,
"width": 640
},
"camera_down": {
"height": 600,
"horizontal_fov": 1.4,
"pose": [
0.0,
0.0,
-0.5,
0.0,
1.5707963267948966,
0.0
],
"update_rate": 5,
"width": 800
},
"dvl": {
"pose": [
0.0,
0.0,
-0.5,
0.0,
0.0,
0.0
],
"range_max": 20,
"update_rate": 1
},
"lidar_2d": {
"pose": [
0.0,
0.0,
2.5,
0.0,
0.0,
0.0
],
"range_max": 50,
"update_rate": 5
}
},
"vehicle": "wamv"
}
-->
<enable_wind>true</enable_wind>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="base_link">
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="visual">
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/04f3ad2d4ac28cde0632b52f0ffaf7bb5f09da574a1a0b1402122ff2e1f2fbea.dae</uri>
</mesh>
</geometry>
</visual>
<!--
物理計算に使う衝突形状です。大きさと位置を船体に合わせてください。単純な形状にすると衝突計算の負荷を減らせます。
-->
<collision name="collision">
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/31b5b6c712bf5c02a523be90f933526bf7a53b6abd84e2e279d8daabec043807.stl</uri>
</mesh>
</geometry>
</collision>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 0 0 0</pose>
<mass>180</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>120</ixx>
<ixy>0</ixy>
<iyy>393</iyy>
<iyz>0</iyz>
<izz>446</izz>
</inertia>
</inertial>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="payload_camera" type="camera">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>5</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/vehicle/sensors/camera</topic>
<!--
カメラ設定です。horizontal_fovは水平画角(rad)、width/heightは画像サイズ(pixel)です。clipのnear/farは描画距離(m)、camera_info_topicはキャリブレーション情報の出力先です。
-->
<camera>
<horizontal_fov>1.4</horizontal_fov>
<image>
<width>640</width>
<height>480</height>
</image>
<clip>
<near>.1</near>
<far>100</far>
</clip>
<camera_info_topic>/vehicle/sensors/camera/camera_info</camera_info_topic>
</camera>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>1.5 0.0 0.8 0.0 0.0 0.0</pose>
<frame_id>vehicle/camera</frame_id>
</sensor>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="payload_camera_down" type="camera">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>5</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/vehicle/sensors/camera_down</topic>
<!--
カメラ設定です。horizontal_fovは水平画角(rad)、width/heightは画像サイズ(pixel)です。clipのnear/farは描画距離(m)、camera_info_topicはキャリブレーション情報の出力先です。
-->
<camera>
<horizontal_fov>1.4</horizontal_fov>
<image>
<width>800</width>
<height>600</height>
</image>
<clip>
<near>.1</near>
<far>100</far>
</clip>
<camera_info_topic>/vehicle/sensors/camera_down/camera_info</camera_info_topic>
</camera>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.0 0.0 -0.5 0.0 1.5707963267948966 0.0</pose>
<frame_id>vehicle/camera_down</frame_id>
</sensor>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="payload_dvl" type="custom" gz:type="dvl">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.0 0.0 -0.5 0.0 0.0 0.0</pose>
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>1</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/vehicle/sensors/dvl</topic>
<!--
DVLのビーム配置と海底追跡の設定です。角度の単位はarrangementの属性で指定し、距離と分解能はmで設定します。ワールドにはDopplerVelocityLogSystemが必要で、ROSアダプターが速度と状態を配信します。
-->
<gz:dvl>
<type>phased_array</type>
<arrangement degrees="true">
<beam id="1">
<aperture>2</aperture>
<rotation>45</rotation>
<tilt>30</tilt>
</beam>
<beam id="2">
<aperture>2</aperture>
<rotation>135</rotation>
<tilt>30</tilt>
</beam>
<beam id="3">
<aperture>2</aperture>
<rotation>-45</rotation>
<tilt>30</tilt>
</beam>
<beam id="4">
<aperture>2</aperture>
<rotation>-135</rotation>
<tilt>30</tilt>
</beam>
</arrangement>
<tracking>
<bottom_mode>
<when>best</when>
<!--
測定ノイズです。ガウスノイズのmeanとstddevは測定量と同じ単位です。stddevでランダムなばらつきの大きさを設定します。
-->
<noise type="gaussian">
<stddev>0.002</stddev>
</noise>
<visualize>false</visualize>
</bottom_mode>
</tracking>
<resolution>0.01</resolution>
<maximum_range>20</maximum_range>
<minimum_range>0.1</minimum_range>
<reference_frame>0 0 0 0 0 0</reference_frame>
</gz:dvl>
<frame_id>vehicle/dvl</frame_id>
</sensor>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="payload_lidar_2d" type="gpu_lidar">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>5</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/vehicle/sensors/lidar_2d</topic>
<!--
レイによる距離センサーです。scanで水平・垂直方向のサンプル数と角度(rad)、rangeで距離範囲と分解能(m)を設定します。Single
PingもこのGPU実装を使用します。
-->
<lidar>
<scan>
<horizontal>
<samples>360</samples>
<resolution>1</resolution>
<min_angle>-3.141592653589793</min_angle>
<max_angle>3.141592653589793</max_angle>
</horizontal>
</scan>
<range>
<min>0.1</min>
<max>50</max>
<resolution>0.01</resolution>
</range>
</lidar>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.0 0.0 2.5 0.0 0.0 0.0</pose>
<frame_id>vehicle/lidar_2d</frame_id>
</sensor>
<!--
選択可能なセンサーcameraの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
width: 64 … 1920 px
height: 64 … 1920 px
horizontal_fov: 0.1 … 3 rad
width * height * update_rate <= 30000000 px/s
Gazebo: /vehicle/sensors/camera
frame_id: vehicle/camera
ROS: /vehicle/sensors/camera (sensor_msgs/msg/Image)
ROS: /vehicle/sensors/camera/camera_info (sensor_msgs/msg/CameraInfo)
<sensor name="payload_camera" type="camera">
<always_on>true</always_on>
<update_rate>5</update_rate>
<topic>/vehicle/sensors/camera</topic>
<camera>
<horizontal_fov>1.4</horizontal_fov>
<image>
<width>640</width>
<height>480</height>
</image>
<clip>
<near>.1</near>
<far>100</far>
</clip>
<camera_info_topic>/vehicle/sensors/camera/camera_info</camera_info_topic>
</camera>
<pose>1.5 0.0 0.8 0.0 0.0 0.0</pose>
<frame_id>vehicle/camera</frame_id>
</sensor>
-->
<!--
選択可能なセンサーcamera_downの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
width: 64 … 1920 px
height: 64 … 1920 px
horizontal_fov: 0.1 … 3 rad
width * height * update_rate <= 30000000 px/s
Gazebo: /vehicle/sensors/camera_down
frame_id: vehicle/camera_down
ROS: /vehicle/sensors/camera_down (sensor_msgs/msg/Image)
ROS: /vehicle/sensors/camera_down/camera_info (sensor_msgs/msg/CameraInfo)
<sensor name="payload_camera_down" type="camera">
<always_on>true</always_on>
<update_rate>5</update_rate>
<topic>/vehicle/sensors/camera_down</topic>
<camera>
<horizontal_fov>1.4</horizontal_fov>
<image>
<width>800</width>
<height>600</height>
</image>
<clip>
<near>.1</near>
<far>100</far>
</clip>
<camera_info_topic>/vehicle/sensors/camera_down/camera_info</camera_info_topic>
</camera>
<pose>0.0 0.0 -0.5 0.0 1.5707963267948966 0.0</pose>
<frame_id>vehicle/camera_down</frame_id>
</sensor>
-->
<!--
選択可能なセンサーping_downの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
range_max: 1 … 100 m
Gazebo: /vehicle/sensors/ping_down
frame_id: vehicle/ping_down
ROS: /vehicle/sensors/ping_down (sensor_msgs/msg/LaserScan)
ROS: /vehicle/sensors/ping_down/range (sensor_msgs/msg/Range)
runtime: practice_ping.py
DVLとSingle Pingはどちらか一方を選択します。同時には有効にできません。
<sensor name="payload_ping_down" type="gpu_lidar">
<always_on>true</always_on>
<update_rate>5</update_rate>
<topic>/vehicle/sensors/ping_down</topic>
<lidar>
<scan>
<horizontal>
<samples>5</samples>
<resolution>1</resolution>
<min_angle>-0.00872665</min_angle>
<max_angle>0.00872665</max_angle>
</horizontal>
<vertical>
<samples>5</samples>
<resolution>1</resolution>
<min_angle>-0.00872665</min_angle>
<max_angle>0.00872665</max_angle>
</vertical>
</scan>
<range>
<min>0.1</min>
<max>30</max>
<resolution>0.01</resolution>
</range>
</lidar>
<pose>0.0 0.0 -0.5 0.0 1.5707963267948966 0.0</pose>
<frame_id>vehicle/ping_down</frame_id>
</sensor>
-->
<!--
選択可能なセンサーmultibeam_forwardの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
Gazebo: /vehicle/sensors/multibeam_forward
frame_id: vehicle/multibeam_forward
ROS: /vehicle/sensors/multibeam_forward/sonar_image_raw (marine_acoustic_msgs/msg/ProjectedSonarImage)
互換性のあるPOSIM音響ソナープロバイダーと対応するワールドシステムが必要です。プロバイダーがなくてもこの例は参照できます。レイ・音響設定はプロバイダーの既定値で、機体エディターでは更新頻度と取り付け位置・姿勢を設定できます。
<sensor xmlns:gz="http://gazebosim.org" name="payload_multibeam_forward" type="custom" gz:type="multibeam_sonar">
<always_on>true</always_on>
<update_rate>2</update_rate>
<topic>/vehicle/sensors/multibeam_forward</topic>
<visualize>true</visualize>
<gz:multibeam_sonar>
<ray degrees="false">
<scan>
<horizontal>
<beams>256</beams>
<min_angle>-1.0471975511965976</min_angle>
<max_angle>1.0471975511965976</max_angle>
</horizontal>
<vertical>
<rays>256</rays>
<min_angle>-0.17453292519943295</min_angle>
<max_angle>0.17453292519943295</max_angle>
</vertical>
</scan>
<range>
<min>0.2</min>
<max>15</max>
</range>
</ray>
<spec>
<verticalFOV>20</verticalFOV>
<sonarFreq>700e3</sonarFreq>
<bandwidth>29.9e3</bandwidth>
<soundSpeed>1500</soundSpeed>
<sourceLevel>220</sourceLevel>
<maxDistance>15</maxDistance>
<raySkips>1</raySkips>
<sensorGain>0.02</sensorGain>
<writeLog>false</writeLog>
<debugFlag>false</debugFlag>
<writeFrameInterval>5</writeFrameInterval>
<pointCloudTopicName>geometry/points</pointCloudTopicName>
<sonarImageRawTopicName>sonar_image_raw</sonarImageRawTopicName>
<sonarImageTopicName>sonar_image</sonarImageTopicName>
<frameName>vehicle/multibeam_forward</frameName>
<visibilityMask>3892314111</visibilityMask>
</spec>
</gz:multibeam_sonar>
<pose>1.5 0.0 -0.5 0.0 0.35 0.0</pose>
<frame_id>vehicle/multibeam_forward</frame_id>
</sensor>
-->
<!--
選択可能なセンサーdvlの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
range_max: 1 … 100 m
Gazebo: /vehicle/sensors/dvl
frame_id: vehicle/dvl
ROS: /vehicle/sensors/dvl/velocity (geometry_msgs/msg/Vector3Stamped)
ROS: /vehicle/sensors/dvl/status (std_msgs/msg/String)
runtime: practice_dvl_bridge.py
DVLとSingle Pingはどちらか一方を選択します。同時には有効にできません。
<sensor xmlns:gz="http://gazebosim.org" name="payload_dvl" type="custom" gz:type="dvl">
<pose>0.0 0.0 -0.5 0.0 0.0 0.0</pose>
<always_on>true</always_on>
<update_rate>1</update_rate>
<topic>/vehicle/sensors/dvl</topic>
<gz:dvl>
<type>phased_array</type>
<arrangement degrees="true">
<beam id="1">
<aperture>2</aperture>
<rotation>45</rotation>
<tilt>30</tilt>
</beam>
<beam id="2">
<aperture>2</aperture>
<rotation>135</rotation>
<tilt>30</tilt>
</beam>
<beam id="3">
<aperture>2</aperture>
<rotation>-45</rotation>
<tilt>30</tilt>
</beam>
<beam id="4">
<aperture>2</aperture>
<rotation>-135</rotation>
<tilt>30</tilt>
</beam>
</arrangement>
<tracking>
<bottom_mode>
<when>best</when>
<noise type="gaussian">
<stddev>0.002</stddev>
</noise>
<visualize>false</visualize>
</bottom_mode>
</tracking>
<resolution>0.01</resolution>
<maximum_range>20</maximum_range>
<minimum_range>0.1</minimum_range>
<reference_frame>0 0 0 0 0 0</reference_frame>
</gz:dvl>
<frame_id>vehicle/dvl</frame_id>
</sensor>
-->
<!--
選択可能なセンサーlidar_2dの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
range_max: 1 … 100 m
Gazebo: /vehicle/sensors/lidar_2d
frame_id: vehicle/lidar_2d
ROS: /vehicle/sensors/lidar_2d (sensor_msgs/msg/LaserScan)
<sensor name="payload_lidar_2d" type="gpu_lidar">
<always_on>true</always_on>
<update_rate>5</update_rate>
<topic>/vehicle/sensors/lidar_2d</topic>
<lidar>
<scan>
<horizontal>
<samples>360</samples>
<resolution>1</resolution>
<min_angle>-3.141592653589793</min_angle>
<max_angle>3.141592653589793</max_angle>
</horizontal>
</scan>
<range>
<min>0.1</min>
<max>50</max>
<resolution>0.01</resolution>
</range>
</lidar>
<pose>0.0 0.0 2.5 0.0 0.0 0.0</pose>
<frame_id>vehicle/lidar_2d</frame_id>
</sensor>
-->
</link>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="left_engine_link">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-2.373776 1.027135 0.318237 0 0 0</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="visual">
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/4fc1c298164ee6bb48d06e66af95a8eec7a63ffaf822b4226750043b316d4e2e.dae</uri>
</mesh>
</geometry>
</visual>
<!--
物理計算に使う衝突形状です。大きさと位置を船体に合わせてください。単純な形状にすると衝突計算の負荷を減らせます。
-->
<collision name="engine_vertical_axis_collision">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.16 0 -0.215 0 0 0</pose>
<geometry>
<box>
<size>0.2 0.1 0.83</size>
</box>
</geometry>
</collision>
<!--
物理計算に使う衝突形状です。大きさと位置を船体に合わせてください。単純な形状にすると衝突計算の負荷を減らせます。
-->
<collision name="engine_rear_end_collision">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.34 0 0.12 0 0 0</pose>
<geometry>
<box>
<size>0.12 0.15 0.12</size>
</box>
</geometry>
</collision>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>15</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.88924</ixx>
<ixy>0</ixy>
<iyy>0.911125</iyy>
<iyz>0</iyz>
<izz>0.078125</izz>
</inertia>
</inertial>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="left_engine_joint" type="fixed">
<parent>base_link</parent>
<child>left_engine_link</child>
</joint>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="right_engine_link">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-2.373776 -1.027135 0.318237 0 0 0</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="visual">
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/4fc1c298164ee6bb48d06e66af95a8eec7a63ffaf822b4226750043b316d4e2e.dae</uri>
</mesh>
</geometry>
</visual>
<!--
物理計算に使う衝突形状です。大きさと位置を船体に合わせてください。単純な形状にすると衝突計算の負荷を減らせます。
-->
<collision name="engine_vertical_axis_collision">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.16 0 -0.215 0 0 0</pose>
<geometry>
<box>
<size>0.2 0.1 0.83</size>
</box>
</geometry>
</collision>
<!--
物理計算に使う衝突形状です。大きさと位置を船体に合わせてください。単純な形状にすると衝突計算の負荷を減らせます。
-->
<collision name="engine_rear_end_collision">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.34 0 0.12 0 0 0</pose>
<geometry>
<box>
<size>0.12 0.15 0.12</size>
</box>
</geometry>
</collision>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>15</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.88924</ixx>
<ixy>0</ixy>
<iyy>0.911125</iyy>
<iyz>0</iyz>
<izz>0.078125</izz>
</inertia>
</inertial>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="right_engine_joint" type="fixed">
<parent>base_link</parent>
<child>right_engine_link</child>
</joint>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="left_propeller_link">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose relative_to="left_propeller_joint">0 0 0 0 0 0</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="visual">
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/2c891453932798e772dab9792855c0ff84fc0315a662eb1c872f8e16bb692c25.dae</uri>
</mesh>
</geometry>
</visual>
<!--
物理計算に使う衝突形状です。大きさと位置を船体に合わせてください。単純な形状にすると衝突計算の負荷を減らせます。
-->
<collision name="collision">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.11 0 0 0 1.570796 0</pose>
<geometry>
<cylinder>
<length>0.08</length>
<radius>0.24</radius>
</cylinder>
</geometry>
</collision>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.5</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.008545</ixx>
<ixy>0</ixy>
<iyy>0.008545</iyy>
<iyz>0</iyz>
<izz>0.0144</izz>
</inertia>
</inertial>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="left_propeller_joint" type="revolute">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose relative_to="left_engine_link">-0.278156 0 -0.509371 0 0 0</pose>
<parent>left_engine_link</parent>
<child>left_propeller_link</child>
<axis>
<xyz>1 0 0</xyz>
<dynamics>
<damping>0.01</damping>
</dynamics>
<limit>
<lower>-1e+16</lower>
<upper>1e+16</upper>
</limit>
</axis>
</joint>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="right_propeller_link">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose relative_to="right_propeller_joint">0 0 0 0 0 0</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="visual">
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/2c891453932798e772dab9792855c0ff84fc0315a662eb1c872f8e16bb692c25.dae</uri>
</mesh>
</geometry>
</visual>
<!--
物理計算に使う衝突形状です。大きさと位置を船体に合わせてください。単純な形状にすると衝突計算の負荷を減らせます。
-->
<collision name="collision">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.11 0 0 0 1.570796 0</pose>
<geometry>
<cylinder>
<length>0.08</length>
<radius>0.24</radius>
</cylinder>
</geometry>
</collision>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.5</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.008545</ixx>
<ixy>0</ixy>
<iyy>0.008545</iyy>
<iyz>0</iyz>
<izz>0.0144</izz>
</inertia>
</inertial>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="right_propeller_joint" type="revolute">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose relative_to="right_engine_link">-0.278156 0 -0.509371 0 0 0</pose>
<parent>right_engine_link</parent>
<child>right_propeller_link</child>
<axis>
<xyz>1 0 0</xyz>
<dynamics>
<damping>0.01</damping>
</dynamics>
<limit>
<lower>-1e+16</lower>
<upper>1e+16</upper>
</limit>
</axis>
</joint>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="imu_link">
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 0 0 0</pose>
<mass>0.15</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.00001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.00002</iyy>
<iyz>0</iyz>
<izz>0.00002</izz>
</inertia>
</inertial>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="imu_sensor" type="imu">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 3.141593 0 0</pose>
<always_on>1</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>200</update_rate>
</sensor>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="imu_joint" type="fixed">
<child>imu_link</child>
<parent>base_link</parent>
</joint>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
プロペラの推力モデルです。fluid_densityはkg/m^3、propeller_diameterはmで、thrust_coefficientは角速度と推力の関係を定めます。use_angvel_cmdがtrueならrad/s、falseならNの指令を受け取ります。
-->
<plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
<namespace>wamv</namespace>
<joint_name>left_propeller_joint</joint_name>
<use_angvel_cmd>0</use_angvel_cmd>
<fluid_density>1000</fluid_density>
<propeller_diameter>0.48</propeller_diameter>
<thrust_coefficient>0.01</thrust_coefficient>
<velocity_control>1</velocity_control>
<max_thrust_cmd>2000.0</max_thrust_cmd>
<min_thrust_cmd>-2000.0</min_thrust_cmd>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
プロペラの推力モデルです。fluid_densityはkg/m^3、propeller_diameterはmで、thrust_coefficientは角速度と推力の関係を定めます。use_angvel_cmdがtrueならrad/s、falseならNの指令を受け取ります。
-->
<plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
<namespace>wamv</namespace>
<joint_name>right_propeller_joint</joint_name>
<use_angvel_cmd>0</use_angvel_cmd>
<fluid_density>1000</fluid_density>
<propeller_diameter>0.48</propeller_diameter>
<thrust_coefficient>0.01</thrust_coefficient>
<velocity_control>1</velocity_control>
<max_thrust_cmd>2000.0</max_thrust_cmd>
<min_thrust_cmd>-2000.0</min_thrust_cmd>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<plugin filename="/opt/wwos/competition_hydrodynamics/lib/libwwos-competition-hydrodynamics.so" name="gz::sim::systems::CompetitionHydrodynamics">
<enable>wamv::base_link</enable>
<!--
流体力の係数です。damping_on、viscous_drag_on、pressure_drag_onで減衰・粘性抵抗・圧力抵抗を有効にします。cDampL/Rは並進・回転の減衰係数です。圧力抵抗係数にはこのモデルに対応する値を使ってください。
-->
<hydrodynamics>
<damping_on>1</damping_on>
<viscous_drag_on>1</viscous_drag_on>
<pressure_drag_on>1</pressure_drag_on>
<cDampL1>1.0E-6</cDampL1>
<cDampL2>1.0E-6</cDampL2>
<cDampR1>1.0E-6</cDampR1>
<cDampR2>1.0E-6</cDampR2>
<cPDrag1>1.0E+2</cPDrag1>
<cPDrag2>1.0E+2</cPDrag2>
<fPDrag>0.4</fPDrag>
<cSDrag1>1.0E+2</cSDrag1>
<cSDrag2>1.0E+2</cSDrag2>
<fSDrag>0.4</fSDrag>
<vRDrag>1.0</vRDrag>
</hydrodynamics>
<current_user_configurable>true</current_user_configurable>
<current_session_tag>0</current_session_tag>
<current_start_enabled>false</current_start_enabled>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
ArduPilotとの接続設定です。ネットワーク接続先、ロックステップ同期、座標変換、IMU名を指定します。機体の物理パラメーターを調整するときも接続設定を維持してください。
-->
<plugin name="ArduPilotPlugin" filename="libArduPilotPlugin.so">
<fdm_addr>127.0.0.1</fdm_addr>
<fdm_port_in>9002</fdm_port_in>
<connectionTimeoutMaxCount>5</connectionTimeoutMaxCount>
<lock_step>1</lock_step>
<modelXYZToAirplaneXForwardZDown>0 0 0 3.14159265359 0 0</modelXYZToAirplaneXForwardZDown>
<gazeboXYZToNED>0 0 0 3.14159265359 0 1.57079632679</gazeboXYZToNED>
<imuName>imu_sensor</imuName>
<!--
制御器のチャンネルをジョイント指令トピックに接続します。servo_min/maxは入力範囲、offsetとmultiplierは出力変換のオフセットと倍率です。チャンネルとトピックの対応を維持してください。
-->
<control channel="0">
<jointName>left_propeller_joint</jointName>
<servo_min>1000</servo_min>
<servo_max>2000</servo_max>
<type>COMMAND</type>
<cmd_topic>/model/wamv/joint/left_propeller_joint/cmd_thrust</cmd_topic>
<offset>-.5</offset>
<multiplier>500</multiplier>
</control>
<!--
制御器のチャンネルをジョイント指令トピックに接続します。servo_min/maxは入力範囲、offsetとmultiplierは出力変換のオフセットと倍率です。チャンネルとトピックの対応を維持してください。
-->
<control channel="2">
<jointName>right_propeller_joint</jointName>
<servo_min>1000</servo_min>
<servo_max>2000</servo_max>
<type>COMMAND</type>
<cmd_topic>/model/wamv/joint/right_propeller_joint/cmd_thrust</cmd_topic>
<offset>-.5</offset>
<multiplier>500</multiplier>
</control>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
指定した座標系と頻度(Hz)でシミュレーションのオドメトリを配信します。シミュレーターの状態を表す値です。模擬センサーの測定値はセンサートピックを使ってください。
-->
<plugin filename="gz-sim-odometry-publisher-system" name="gz::sim::systems::OdometryPublisher">
<dimensions>3</dimensions>
<odom_frame>map</odom_frame>
<robot_base_frame>base_link</robot_base_frame>
<odom_publish_frequency>20</odom_publish_frequency>
<odom_topic>/model/wamv/odometry</odom_topic>
</plugin>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="gnss_link">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose relative_to="base_link">0 0 1.8 0 0 0</pose>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>.001</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.000001</ixx>
<iyy>0.000001</iyy>
<izz>0.000001</izz>
</inertia>
</inertial>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="gnss" type="custom" gz:type="posim_gnss">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>5</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/model/wamv/gnss</topic>
</sensor>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="gnss_joint" type="fixed">
<parent>base_link</parent>
<child>gnss_link</child>
</joint>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
GNSS受信機モデルです。update_rateはHz、latencyとreacquire_secondsは秒です。位置ノイズとdry_marginはm、velocity_stddevはm/sです。link_name、topic、wave_topicでアンテナ・出力・水面入力を接続します。
-->
<plugin name="posim::Gnss" filename="libposim_gnss.so">
<update_rate>5</update_rate>
<latency>0.2</latency>
<reacquire_seconds>3</reacquire_seconds>
<dry_margin>0.05</dry_margin>
<horizontal_stddev>0.7</horizontal_stddev>
<vertical_stddev>1.2</vertical_stddev>
<velocity_stddev>0.1</velocity_stddev>
<water_level>0</water_level>
<seed>42</seed>
<enabled>true</enabled>
<link_name>gnss_link</link_name>
<topic>/model/wamv/gnss</topic>
<wave_topic>/wwos/wave_surface</wave_topic>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<plugin filename="gz-sim-pose-publisher-system" name="gz::sim::systems::PosePublisher">
<publish_model_pose>true</publish_model_pose>
<publish_link_pose>true</publish_link_pose>
<publish_sensor_pose>true</publish_sensor_pose>
<publish_nested_model_pose>true</publish_nested_model_pose>
<publish_visual_pose>false</publish_visual_pose>
<publish_collision_pose>false</publish_collision_pose>
<use_pose_vector_msg>true</use_pose_vector_msg>
<update_frequency>20</update_frequency>
<topic>/model/wamv/wwos/poses</topic>
</plugin>
</model>
</sdf>
BlueROV2の完全なSDF
BlueROV2 model.sdfをダウンロード。両カメラ、単一Ping、Autopilot、GNSSを有効にした例です。DVLと音響プロバイダーの設定もコメントで確認できます。DVLとPingは選択式です。
bluerov2.sdf
<?xml version='1.0' encoding='utf-8'?>
<sdf xmlns:gz="http://gazebosim.org" version="1.6">
<!--
モデルの構成です。linkで剛体、jointで剛体間の接続を定義し、pluginでシミュレーション機能を追加します。名前はエクスポートした制御設定と一致させてください。
-->
<model name="bluerov2">
<!--
エクスポートした機体設定です。このコメントの後に有効なモデルが続きます。センサーとプロバイダーは機体エディターで選び、トピックとワールドシステムを一致させてください。取り付け範囲:位置±10 m、回転±2π rad。recipe.json:
{
"control_mode": "autopilot",
"gnss": true,
"schema_version": 1,
"sensors": [
"camera",
"camera_down",
"ping_down"
],
"settings": {
"camera": {
"height": 480,
"horizontal_fov": 1.4,
"pose": [
0.4,
0.0,
-0.1,
0.0,
0.0,
0.0
],
"update_rate": 5,
"width": 640
},
"camera_down": {
"height": 600,
"horizontal_fov": 1.4,
"pose": [
-0.1,
0.0,
0.0,
0.0,
1.5707963267948966,
0.0
],
"update_rate": 5,
"width": 800
},
"ping_down": {
"pose": [
-0.15,
0.0,
-0.095,
0.0,
1.5707963267948966,
0.0
],
"range_max": 30,
"update_rate": 5
}
},
"vehicle": "bluerov2"
}
-->
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 0 0 0</pose>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="base_link">
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.0 0.0 0.011 0 0 0</pose>
<mass>10.0</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.099</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.178</iyy>
<iyz>0</iyz>
<izz>0.269</izz>
</inertia>
</inertial>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="base_link_visual">
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/c73a7bc28f98fdcad54bf77d3ca61d26bb299e0d39be90cb56b77314d1499dde.dae</uri>
<scale>0.025 0.025 0.025</scale>
</mesh>
</geometry>
</visual>
<!--
物理計算に使う衝突形状です。大きさと位置を船体に合わせてください。単純な形状にすると衝突計算の負荷を減らせます。
-->
<collision name="base_link_collision">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.0 0.0 0.06 0 0 0</pose>
<geometry>
<box>
<size>0.457 0.338 0.065</size>
</box>
</geometry>
</collision>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="imu_sensor" type="imu">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 3.142 0 0</pose>
<always_on>1</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>1000.0</update_rate>
</sensor>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="wwos_magnetometer" type="magnetometer">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>20</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/model/bluerov2/magnetometer</topic>
</sensor>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="payload_camera" type="camera">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>5</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/vehicle/sensors/camera</topic>
<!--
カメラ設定です。horizontal_fovは水平画角(rad)、width/heightは画像サイズ(pixel)です。clipのnear/farは描画距離(m)、camera_info_topicはキャリブレーション情報の出力先です。
-->
<camera>
<horizontal_fov>1.4</horizontal_fov>
<image>
<width>640</width>
<height>480</height>
</image>
<clip>
<near>.1</near>
<far>100</far>
</clip>
<camera_info_topic>/vehicle/sensors/camera/camera_info</camera_info_topic>
</camera>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.4 0.0 -0.1 0.0 0.0 0.0</pose>
<frame_id>vehicle/camera</frame_id>
</sensor>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="payload_camera_down" type="camera">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>5</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/vehicle/sensors/camera_down</topic>
<!--
カメラ設定です。horizontal_fovは水平画角(rad)、width/heightは画像サイズ(pixel)です。clipのnear/farは描画距離(m)、camera_info_topicはキャリブレーション情報の出力先です。
-->
<camera>
<horizontal_fov>1.4</horizontal_fov>
<image>
<width>800</width>
<height>600</height>
</image>
<clip>
<near>.1</near>
<far>100</far>
</clip>
<camera_info_topic>/vehicle/sensors/camera_down/camera_info</camera_info_topic>
</camera>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.1 0.0 0.0 0.0 1.5707963267948966 0.0</pose>
<frame_id>vehicle/camera_down</frame_id>
</sensor>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="payload_ping_down" type="gpu_lidar">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>5</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/vehicle/sensors/ping_down</topic>
<!--
レイによる距離センサーです。scanで水平・垂直方向のサンプル数と角度(rad)、rangeで距離範囲と分解能(m)を設定します。Single
PingもこのGPU実装を使用します。
-->
<lidar>
<scan>
<horizontal>
<samples>5</samples>
<resolution>1</resolution>
<min_angle>-0.00872665</min_angle>
<max_angle>0.00872665</max_angle>
</horizontal>
<vertical>
<samples>5</samples>
<resolution>1</resolution>
<min_angle>-0.00872665</min_angle>
<max_angle>0.00872665</max_angle>
</vertical>
</scan>
<range>
<min>0.1</min>
<max>30</max>
<resolution>0.01</resolution>
</range>
</lidar>
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.15 0.0 -0.095 0.0 1.5707963267948966 0.0</pose>
<frame_id>vehicle/ping_down</frame_id>
</sensor>
<!--
選択可能なセンサーcameraの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
width: 64 … 1920 px
height: 64 … 1920 px
horizontal_fov: 0.1 … 3 rad
width * height * update_rate <= 30000000 px/s
Gazebo: /vehicle/sensors/camera
frame_id: vehicle/camera
ROS: /vehicle/sensors/camera (sensor_msgs/msg/Image)
ROS: /vehicle/sensors/camera/camera_info (sensor_msgs/msg/CameraInfo)
<sensor name="payload_camera" type="camera">
<always_on>true</always_on>
<update_rate>5</update_rate>
<topic>/vehicle/sensors/camera</topic>
<camera>
<horizontal_fov>1.4</horizontal_fov>
<image>
<width>640</width>
<height>480</height>
</image>
<clip>
<near>.1</near>
<far>100</far>
</clip>
<camera_info_topic>/vehicle/sensors/camera/camera_info</camera_info_topic>
</camera>
<pose>0.4 0.0 -0.1 0.0 0.0 0.0</pose>
<frame_id>vehicle/camera</frame_id>
</sensor>
-->
<!--
選択可能なセンサーcamera_downの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
width: 64 … 1920 px
height: 64 … 1920 px
horizontal_fov: 0.1 … 3 rad
width * height * update_rate <= 30000000 px/s
Gazebo: /vehicle/sensors/camera_down
frame_id: vehicle/camera_down
ROS: /vehicle/sensors/camera_down (sensor_msgs/msg/Image)
ROS: /vehicle/sensors/camera_down/camera_info (sensor_msgs/msg/CameraInfo)
<sensor name="payload_camera_down" type="camera">
<always_on>true</always_on>
<update_rate>5</update_rate>
<topic>/vehicle/sensors/camera_down</topic>
<camera>
<horizontal_fov>1.4</horizontal_fov>
<image>
<width>800</width>
<height>600</height>
</image>
<clip>
<near>.1</near>
<far>100</far>
</clip>
<camera_info_topic>/vehicle/sensors/camera_down/camera_info</camera_info_topic>
</camera>
<pose>-0.1 0.0 0.0 0.0 1.5707963267948966 0.0</pose>
<frame_id>vehicle/camera_down</frame_id>
</sensor>
-->
<!--
選択可能なセンサーping_downの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
range_max: 1 … 100 m
Gazebo: /vehicle/sensors/ping_down
frame_id: vehicle/ping_down
ROS: /vehicle/sensors/ping_down (sensor_msgs/msg/LaserScan)
ROS: /vehicle/sensors/ping_down/range (sensor_msgs/msg/Range)
runtime: practice_ping.py
DVLとSingle Pingはどちらか一方を選択します。同時には有効にできません。
<sensor name="payload_ping_down" type="gpu_lidar">
<always_on>true</always_on>
<update_rate>5</update_rate>
<topic>/vehicle/sensors/ping_down</topic>
<lidar>
<scan>
<horizontal>
<samples>5</samples>
<resolution>1</resolution>
<min_angle>-0.00872665</min_angle>
<max_angle>0.00872665</max_angle>
</horizontal>
<vertical>
<samples>5</samples>
<resolution>1</resolution>
<min_angle>-0.00872665</min_angle>
<max_angle>0.00872665</max_angle>
</vertical>
</scan>
<range>
<min>0.1</min>
<max>30</max>
<resolution>0.01</resolution>
</range>
</lidar>
<pose>-0.15 0.0 -0.095 0.0 1.5707963267948966 0.0</pose>
<frame_id>vehicle/ping_down</frame_id>
</sensor>
-->
<!--
選択可能なセンサーmultibeam_forwardの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
Gazebo: /vehicle/sensors/multibeam_forward
frame_id: vehicle/multibeam_forward
ROS: /vehicle/sensors/multibeam_forward/sonar_image_raw (marine_acoustic_msgs/msg/ProjectedSonarImage)
互換性のあるPOSIM音響ソナープロバイダーと対応するワールドシステムが必要です。プロバイダーがなくてもこの例は参照できます。レイ・音響設定はプロバイダーの既定値で、機体エディターでは更新頻度と取り付け位置・姿勢を設定できます。
<sensor xmlns:gz="http://gazebosim.org" name="payload_multibeam_forward" type="custom" gz:type="multibeam_sonar">
<always_on>true</always_on>
<update_rate>2</update_rate>
<topic>/vehicle/sensors/multibeam_forward</topic>
<visualize>true</visualize>
<gz:multibeam_sonar>
<ray degrees="false">
<scan>
<horizontal>
<beams>256</beams>
<min_angle>-1.0471975511965976</min_angle>
<max_angle>1.0471975511965976</max_angle>
</horizontal>
<vertical>
<rays>256</rays>
<min_angle>-0.17453292519943295</min_angle>
<max_angle>0.17453292519943295</max_angle>
</vertical>
</scan>
<range>
<min>0.2</min>
<max>15</max>
</range>
</ray>
<spec>
<verticalFOV>20</verticalFOV>
<sonarFreq>700e3</sonarFreq>
<bandwidth>29.9e3</bandwidth>
<soundSpeed>1500</soundSpeed>
<sourceLevel>220</sourceLevel>
<maxDistance>15</maxDistance>
<raySkips>1</raySkips>
<sensorGain>0.02</sensorGain>
<writeLog>false</writeLog>
<debugFlag>false</debugFlag>
<writeFrameInterval>5</writeFrameInterval>
<pointCloudTopicName>geometry/points</pointCloudTopicName>
<sonarImageRawTopicName>sonar_image_raw</sonarImageRawTopicName>
<sonarImageTopicName>sonar_image</sonarImageTopicName>
<frameName>vehicle/multibeam_forward</frameName>
<visibilityMask>3892314111</visibilityMask>
</spec>
</gz:multibeam_sonar>
<pose>0.24 0.0 -0.1 0.0 0.35 0.0</pose>
<frame_id>vehicle/multibeam_forward</frame_id>
</sensor>
-->
<!--
選択可能なセンサーdvlの無効なデフォルト例です。実際に選択されたセンサーは、モデル内の有効なpayload_*要素で定義されます。選択は機体エディターで変更し、この例はコメントのままにしてください。編集範囲と出力先:
update_rate: 0.1 … 30 Hz
range_max: 1 … 100 m
Gazebo: /vehicle/sensors/dvl
frame_id: vehicle/dvl
ROS: /vehicle/sensors/dvl/velocity (geometry_msgs/msg/Vector3Stamped)
ROS: /vehicle/sensors/dvl/status (std_msgs/msg/String)
runtime: practice_dvl_bridge.py
DVLとSingle Pingはどちらか一方を選択します。同時には有効にできません。
<sensor xmlns:gz="http://gazebosim.org" name="payload_dvl" type="custom" gz:type="dvl">
<pose>0.0 0.0 -0.12 0.0 0.0 0.0</pose>
<always_on>true</always_on>
<update_rate>1</update_rate>
<topic>/vehicle/sensors/dvl</topic>
<gz:dvl>
<type>phased_array</type>
<arrangement degrees="true">
<beam id="1">
<aperture>2</aperture>
<rotation>45</rotation>
<tilt>30</tilt>
</beam>
<beam id="2">
<aperture>2</aperture>
<rotation>135</rotation>
<tilt>30</tilt>
</beam>
<beam id="3">
<aperture>2</aperture>
<rotation>-45</rotation>
<tilt>30</tilt>
</beam>
<beam id="4">
<aperture>2</aperture>
<rotation>-135</rotation>
<tilt>30</tilt>
</beam>
</arrangement>
<tracking>
<bottom_mode>
<when>best</when>
<noise type="gaussian">
<stddev>0.002</stddev>
</noise>
<visualize>false</visualize>
</bottom_mode>
</tracking>
<resolution>0.01</resolution>
<maximum_range>20</maximum_range>
<minimum_range>0.1</minimum_range>
<reference_frame>0 0 0 0 0 0</reference_frame>
</gz:dvl>
<frame_id>vehicle/dvl</frame_id>
</sensor>
-->
</link>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="camera_link">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose relative_to="camera_mount_link">0 0 0 0 0 0</pose>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.0001</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.0001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.0001</iyy>
<iyz>0</iyz>
<izz>0.0001</izz>
</inertia>
</inertial>
</link>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="camera_mount_link">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose relative_to="base_link">0.19 0 0.067 0 0 0</pose>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.0001</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.0001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.0001</iyy>
<iyz>0</iyz>
<izz>0.0001</izz>
</inertia>
</inertial>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="camera_joint" type="fixed">
<parent>camera_mount_link</parent>
<child>camera_link</child>
</joint>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="camera_mount_joint" type="fixed">
<parent>base_link</parent>
<child>camera_mount_link</child>
</joint>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="thruster1">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.14 -0.092 0.0 -1.571 1.571 -0.785</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="thruster_prop_visual">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 -1.571 0 0</pose>
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
</mesh>
</geometry>
</visual>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.002</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.001</iyy>
<iyz>0</iyz>
<izz>0.001</izz>
</inertia>
</inertial>
</link>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="thruster2">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.14 0.092 0.0 -1.571 1.571 -2.356</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="thruster_prop_visual">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 -1.571 0 0</pose>
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
</mesh>
</geometry>
</visual>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.002</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.001</iyy>
<iyz>0</iyz>
<izz>0.001</izz>
</inertia>
</inertial>
</link>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="thruster3">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.15 -0.092 0.0 -1.571 1.571 0.785</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="thruster_prop_visual">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 1.571 0 0</pose>
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
</mesh>
</geometry>
</visual>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.002</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.001</iyy>
<iyz>0</iyz>
<izz>0.001</izz>
</inertia>
</inertial>
</link>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="thruster4">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>-0.15 0.092 0.0 -1.571 1.571 2.356</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="thruster_prop_visual">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 1.571 0 0</pose>
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
</mesh>
</geometry>
</visual>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.002</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.001</iyy>
<iyz>0</iyz>
<izz>0.001</izz>
</inertia>
</inertial>
</link>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="thruster5">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.0 -0.109 0.077 0 0 0</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="thruster_prop_visual">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 -1.571 0 1.571</pose>
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
</mesh>
</geometry>
</visual>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.002</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.001</iyy>
<iyz>0</iyz>
<izz>0.001</izz>
</inertia>
</inertial>
</link>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="thruster6">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0.0 0.109 0.077 0 0 0</pose>
<!--
画面やカメラに映る形状です。変更しても衝突形状や質量は自動では変わりません。
-->
<visual name="thruster_prop_visual">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose>0 0 0 1.571 0 1.571</pose>
<geometry>
<!--
メッシュファイルと軸ごとの倍率です。エクスポートしたパスとリソースを一緒に保存してください。scaleはメッシュ座標に掛ける倍率です。
-->
<mesh>
<uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
</mesh>
</geometry>
</visual>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>0.002</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.001</ixx>
<ixy>0</ixy>
<ixz>0</ixz>
<iyy>0.001</iyy>
<iyz>0</iyz>
<izz>0.001</izz>
</inertia>
</inertial>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="thruster1_joint" type="revolute">
<parent>base_link</parent>
<child>thruster1</child>
<axis>
<xyz>0 0 -1</xyz>
</axis>
</joint>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="thruster2_joint" type="revolute">
<parent>base_link</parent>
<child>thruster2</child>
<axis>
<xyz>0 0 -1</xyz>
</axis>
</joint>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="thruster3_joint" type="revolute">
<parent>base_link</parent>
<child>thruster3</child>
<axis>
<xyz>0 0 -1</xyz>
</axis>
</joint>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="thruster4_joint" type="revolute">
<parent>base_link</parent>
<child>thruster4</child>
<axis>
<xyz>0 0 -1</xyz>
</axis>
</joint>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="thruster5_joint" type="revolute">
<parent>base_link</parent>
<child>thruster5</child>
<axis>
<xyz>0 0 -1</xyz>
</axis>
</joint>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="thruster6_joint" type="revolute">
<parent>base_link</parent>
<child>thruster6</child>
<axis>
<xyz>0 0 -1</xyz>
</axis>
</joint>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
プロペラの推力モデルです。fluid_densityはkg/m^3、propeller_diameterはmで、thrust_coefficientは角速度と推力の関係を定めます。use_angvel_cmdがtrueならrad/s、falseならNの指令を受け取ります。
-->
<plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
<namespace>bluerov2</namespace>
<joint_name>thruster1_joint</joint_name>
<thrust_coefficient>0.02</thrust_coefficient>
<fluid_density>1025.0</fluid_density>
<propeller_diameter>0.1</propeller_diameter>
<velocity_control>true</velocity_control>
<use_angvel_cmd>False</use_angvel_cmd>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
プロペラの推力モデルです。fluid_densityはkg/m^3、propeller_diameterはmで、thrust_coefficientは角速度と推力の関係を定めます。use_angvel_cmdがtrueならrad/s、falseならNの指令を受け取ります。
-->
<plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
<namespace>bluerov2</namespace>
<joint_name>thruster2_joint</joint_name>
<thrust_coefficient>0.02</thrust_coefficient>
<fluid_density>1025.0</fluid_density>
<propeller_diameter>0.1</propeller_diameter>
<velocity_control>true</velocity_control>
<use_angvel_cmd>False</use_angvel_cmd>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
プロペラの推力モデルです。fluid_densityはkg/m^3、propeller_diameterはmで、thrust_coefficientは角速度と推力の関係を定めます。use_angvel_cmdがtrueならrad/s、falseならNの指令を受け取ります。
-->
<plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
<namespace>bluerov2</namespace>
<joint_name>thruster3_joint</joint_name>
<thrust_coefficient>-0.02</thrust_coefficient>
<fluid_density>1025.0</fluid_density>
<propeller_diameter>0.1</propeller_diameter>
<velocity_control>true</velocity_control>
<use_angvel_cmd>False</use_angvel_cmd>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
プロペラの推力モデルです。fluid_densityはkg/m^3、propeller_diameterはmで、thrust_coefficientは角速度と推力の関係を定めます。use_angvel_cmdがtrueならrad/s、falseならNの指令を受け取ります。
-->
<plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
<namespace>bluerov2</namespace>
<joint_name>thruster4_joint</joint_name>
<thrust_coefficient>-0.02</thrust_coefficient>
<fluid_density>1025.0</fluid_density>
<propeller_diameter>0.1</propeller_diameter>
<velocity_control>true</velocity_control>
<use_angvel_cmd>False</use_angvel_cmd>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
プロペラの推力モデルです。fluid_densityはkg/m^3、propeller_diameterはmで、thrust_coefficientは角速度と推力の関係を定めます。use_angvel_cmdがtrueならrad/s、falseならNの指令を受け取ります。
-->
<plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
<namespace>bluerov2</namespace>
<joint_name>thruster5_joint</joint_name>
<thrust_coefficient>0.02</thrust_coefficient>
<fluid_density>1025.0</fluid_density>
<propeller_diameter>0.1</propeller_diameter>
<velocity_control>true</velocity_control>
<use_angvel_cmd>False</use_angvel_cmd>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
プロペラの推力モデルです。fluid_densityはkg/m^3、propeller_diameterはmで、thrust_coefficientは角速度と推力の関係を定めます。use_angvel_cmdがtrueならrad/s、falseならNの指令を受け取ります。
-->
<plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
<namespace>bluerov2</namespace>
<joint_name>thruster6_joint</joint_name>
<thrust_coefficient>-0.02</thrust_coefficient>
<fluid_density>1025.0</fluid_density>
<propeller_diameter>0.1</propeller_diameter>
<velocity_control>true</velocity_control>
<use_angvel_cmd>False</use_angvel_cmd>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
ArduPilotとの接続設定です。ネットワーク接続先、ロックステップ同期、座標変換、IMU名を指定します。機体の物理パラメーターを調整するときも接続設定を維持してください。
-->
<plugin name="ArduPilotPlugin" filename="libArduPilotPlugin.so">
<fdm_addr>127.0.0.1</fdm_addr>
<fdm_port_in>9002</fdm_port_in>
<connectionTimeoutMaxCount>5</connectionTimeoutMaxCount>
<lock_step>1</lock_step>
<modelXYZToAirplaneXForwardZDown>0 0 0 3.142 0 0</modelXYZToAirplaneXForwardZDown>
<gazeboXYZToNED>0 0 0 3.142 0 1.571</gazeboXYZToNED>
<imuName>imu_sensor</imuName>
<!--
制御器のチャンネルをジョイント指令トピックに接続します。servo_min/maxは入力範囲、offsetとmultiplierは出力変換のオフセットと倍率です。チャンネルとトピックの対応を維持してください。
-->
<control channel="0">
<jointName>thruster1_joint</jointName>
<servo_min>1100</servo_min>
<servo_max>1900</servo_max>
<type>COMMAND</type>
<cmd_topic>/model/bluerov2/joint/thruster1_joint/cmd_thrust</cmd_topic>
<offset>-0.5</offset>
<multiplier>100</multiplier>
</control>
<!--
制御器のチャンネルをジョイント指令トピックに接続します。servo_min/maxは入力範囲、offsetとmultiplierは出力変換のオフセットと倍率です。チャンネルとトピックの対応を維持してください。
-->
<control channel="1">
<jointName>thruster2_joint</jointName>
<servo_min>1100</servo_min>
<servo_max>1900</servo_max>
<type>COMMAND</type>
<cmd_topic>/model/bluerov2/joint/thruster2_joint/cmd_thrust</cmd_topic>
<offset>-0.5</offset>
<multiplier>100</multiplier>
</control>
<!--
制御器のチャンネルをジョイント指令トピックに接続します。servo_min/maxは入力範囲、offsetとmultiplierは出力変換のオフセットと倍率です。チャンネルとトピックの対応を維持してください。
-->
<control channel="2">
<jointName>thruster3_joint</jointName>
<servo_min>1100</servo_min>
<servo_max>1900</servo_max>
<type>COMMAND</type>
<cmd_topic>/model/bluerov2/joint/thruster3_joint/cmd_thrust</cmd_topic>
<offset>-0.5</offset>
<multiplier>100</multiplier>
</control>
<!--
制御器のチャンネルをジョイント指令トピックに接続します。servo_min/maxは入力範囲、offsetとmultiplierは出力変換のオフセットと倍率です。チャンネルとトピックの対応を維持してください。
-->
<control channel="3">
<jointName>thruster4_joint</jointName>
<servo_min>1100</servo_min>
<servo_max>1900</servo_max>
<type>COMMAND</type>
<cmd_topic>/model/bluerov2/joint/thruster4_joint/cmd_thrust</cmd_topic>
<offset>-0.5</offset>
<multiplier>100</multiplier>
</control>
<!--
制御器のチャンネルをジョイント指令トピックに接続します。servo_min/maxは入力範囲、offsetとmultiplierは出力変換のオフセットと倍率です。チャンネルとトピックの対応を維持してください。
-->
<control channel="4">
<jointName>thruster5_joint</jointName>
<servo_min>1100</servo_min>
<servo_max>1900</servo_max>
<type>COMMAND</type>
<cmd_topic>/model/bluerov2/joint/thruster5_joint/cmd_thrust</cmd_topic>
<offset>-0.5</offset>
<multiplier>100</multiplier>
</control>
<!--
制御器のチャンネルをジョイント指令トピックに接続します。servo_min/maxは入力範囲、offsetとmultiplierは出力変換のオフセットと倍率です。チャンネルとトピックの対応を維持してください。
-->
<control channel="5">
<jointName>thruster6_joint</jointName>
<servo_min>1100</servo_min>
<servo_max>1900</servo_max>
<type>COMMAND</type>
<cmd_topic>/model/bluerov2/joint/thruster6_joint/cmd_thrust</cmd_topic>
<offset>-0.5</offset>
<multiplier>100</multiplier>
</control>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
指定した座標系と頻度(Hz)でシミュレーションのオドメトリを配信します。シミュレーターの状態を表す値です。模擬センサーの測定値はセンサートピックを使ってください。
-->
<plugin filename="gz-sim-odometry-publisher-system" name="gz::sim::systems::OdometryPublisher">
<odom_frame>map</odom_frame>
<robot_base_frame>base_link</robot_base_frame>
<dimensions>3</dimensions>
<odom_publish_frequency>100</odom_publish_frequency>
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<plugin filename="gz-sim-joint-state-publisher-system" name="gz::sim::systems::JointStatePublisher">
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<plugin filename="gz-sim-imu-system" name="gz::sim::systems::Imu">
</plugin>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<plugin filename="gz-waves1-hydrodynamics-system" name="gz::sim::systems::Hydrodynamics">
<enable>bluerov2::base_link</enable>
<!--
流体力の係数です。damping_on、viscous_drag_on、pressure_drag_onで減衰・粘性抵抗・圧力抵抗を有効にします。cDampL/Rは並進・回転の減衰係数です。圧力抵抗係数にはこのモデルに対応する値を使ってください。
-->
<hydrodynamics>
<damping_on>1</damping_on>
<viscous_drag_on>0</viscous_drag_on>
<pressure_drag_on>0</pressure_drag_on>
<cDampL1>.1</cDampL1>
<cDampL2>40</cDampL2>
<cDampR1>.1</cDampR1>
<cDampR2>4</cDampR2>
</hydrodynamics>
</plugin>
<!--
剛体とそのローカル座標系です。このリンクの形状、質量特性、センサーは一体として動きます。
-->
<link name="gnss_link">
<!--
位置・姿勢です。x y zはm、続くroll pitch yawはradです。relative_toの指定がなければ親の座標系を基準にします。
-->
<pose relative_to="base_link">0 0 0.3 0 0 0</pose>
<!--
質量特性です。massの単位はkgです。poseはリンクに対する重心座標系の位置と向きを表します。実測値やCADの計算値を使ってください。
-->
<inertial>
<mass>.001</mass>
<!--
重心まわりの慣性テンソルで、単位はkg*m^2です。ixx/iyy/izzは対角成分、ixy/ixz/iyzは非対角成分です。質量と形状に整合する値を使ってください。
-->
<inertia>
<ixx>0.000001</ixx>
<iyy>0.000001</iyy>
<izz>0.000001</izz>
</inertia>
</inertial>
<!--
このリンクに取り付けたセンサーです。poseで取り付け位置・姿勢、typeで測定方式を指定します。機体エディターはトピック接続や必要なワールドシステムも設定します。
-->
<sensor name="gnss" type="custom" gz:type="posim_gnss">
<always_on>true</always_on>
<!--
要求するセンサー更新頻度で、単位はHzです。実際の受信頻度はシミュレーション速度や描画負荷にも左右されます。
-->
<update_rate>5</update_rate>
<!--
Gazebo Transportの出力トピックです。エクスポートしたセンサーマニフェストとROSブリッジの接続設定に合わせてください。
-->
<topic>/model/bluerov2/gnss</topic>
</sensor>
</link>
<!--
parentとchildのリンクを結ぶジョイントです。fixedは相対運動を固定し、revoluteはaxis/xyzまわりの回転を許可します。推進器や制御プラグインが参照する名前を維持してください。
-->
<joint name="gnss_joint" type="fixed">
<parent>base_link</parent>
<child>gnss_link</child>
</joint>
<!--
エンジンプラグインです。filenameはインストール済みライブラリ、nameは実装を指定します。数値設定をアップロードするときも両方を維持してください。SDFファイルでプラグイン自体はインストールできません。
-->
<!--
GNSS受信機モデルです。update_rateはHz、latencyとreacquire_secondsは秒です。位置ノイズとdry_marginはm、velocity_stddevはm/sです。link_name、topic、wave_topicでアンテナ・出力・水面入力を接続します。
-->
<plugin name="posim::Gnss" filename="libposim_gnss.so">
<update_rate>5</update_rate>
<latency>0.2</latency>
<reacquire_seconds>3</reacquire_seconds>
<dry_margin>0.05</dry_margin>
<horizontal_stddev>0.7</horizontal_stddev>
<vertical_stddev>1.2</vertical_stddev>
<velocity_stddev>0.1</velocity_stddev>
<water_level>0</water_level>
<seed>42</seed>
<enabled>true</enabled>
<link_name>gnss_link</link_name>
<topic>/model/bluerov2/gnss</topic>
<wave_topic>/wwos/wave_surface</wave_topic>
</plugin>
</model>
</sdf>
設定をほかのホストへ移す
ZIPをエクスポートにはSDF、メッシュ、レシピ、センサーマニフェストが含まれます。機体をインポートはインストール済みテンプレートを再生成してSDFの変更を検証し、対応する数値変更を保持します。エンジンの版やプロバイダーが異なると再生成が必要になる場合があります。コピーを編集して対応テンプレートを出力し、変更を移してください。
モデルと自分のメッシュを読み込む
ワークスペースのロボット欄で、SDF単体またはSDFとメッシュを含むZIPをアップロードします。
| 上限 | Web | インストール版 |
|---|---|---|
| アップロードファイル | 20 MB | 200 MB |
| 展開後の合計 | 50 MB | 500 MB |
| ルートSDF | 1 MB | 1 MB |
ZIP内では相対パスを使い、リンク、衝突形状、慣性を定義します。アーカイブのパスと対応プラグインを検証し、外部実行ファイルは拒否します。新しいワールドの開始時にリビジョンを選びます。センサーと取付位置の変更には再起動が必要です。
質量や慣性を編集するときは、重心、テンソル、衝突形状、メッシュ倍率をまとめて確認します。テンソルが小さすぎると、見た目が正しくても急激な動きが発生する場合があります。次は書式を示す例です。
<inertial>
<mass>12.0</mass>
<inertia>
<ixx>0.22</ixx><iyy>0.35</iyy><izz>0.40</izz>
<ixy>0</ixy><ixz>0</ixz><iyz>0</iyz>
</inertia>
</inertial>
実測値またはCAD計算を使い、正定値性とkg·m²の単位を確認します。長い経路の前に静止・低速試験を行ってください。
CADから閉じた三角形メッシュのSTLを出力します。
my-robot.zip
model.sdf
meshes/hull.stl
STLには単位がありません。mで出力するか、明示的な倍率を指定します。mmなら0.001 0.001 0.001です。表示形状の参照例:
<visual name="hull_visual">
<geometry><mesh>
<uri>meshes/hull.stl</uri>
<scale>1 1 1</scale>
</mesh></geometry>
</visual>
衝突には箱、円柱、簡略化した閉じたメッシュを使い、<inertial>に質量と慣性を定義します。センサー、アクチュエーター、流体力にはSDFと実行プロファイルの設定が必要で、制御器を指令トピックへ接続します。生成したトピックはセンサーツリーに表示されます。
ブラウザは検証済みSTLを表示用に変換し、Gazeboは元の形状を使用します。SDFの整形はXMLを字下げし、属性、パス、コメントを保持します。不正なXMLでもエディター内の文章は残ります。
保存容量と制御
モデル、元ZIP、アーカイブ済みリビジョンも保存容量に含まれます。重複メッシュや不要な素材を除いて上限内に収めます。アーカイブは一覧から隠す操作で、データは保持します。そのリビジョンを使う実行中・待機中セッションが終わってから行ってください。アーカイブと復元はワークスペースのストレージから操作できます。
自律制御プログラムやROS依存パッケージはインストール版のワークスペースを制御でローカル実行します。ネイティブプラグインとサーバーノードには対応依存関係を持つ実行プロファイルが必要です。ArduPilotの値はディスアームしてから変更し、読み戻して確認します。オートパイロットのミッションを参照してください。
個人ワークスペースは同時に1機体を実行します。LIVE 世界航海のWAM-V 2隻は専用構成で、汎用的な複数機体エディターは用意されていません。