diff --git a/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/left_L_path_test.world b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/left_L_path_test.world
new file mode 100644
index 000000000..a22dbb490
--- /dev/null
+++ b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/left_L_path_test.world
@@ -0,0 +1,3882 @@
+
+
+
+ EARTH_WGS84
+ ENU
+ -33.7242
+ 150.68
+ 0
+ 0
+
+
+ 1
+ 0 0 10 0 -0 0
+ 0.8 0.8 0.8 1
+ 0.2 0.2 0.2 1
+
+ 1000
+ 0.9
+ 0.01
+ 0.001
+
+ -0.5 0.1 -0.9
+
+ 0
+ 0
+ 0
+
+
+
+
+ -538.242 206.204 110.6 3.14159 1.57079 3.14159
+ orbit
+ perspective
+
+
+
+ 0 0 0.2 0 -0 0
+ 1
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Terrain
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ ConcreteDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ DockDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ MetalGalvanized
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Dock
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Windows_Dark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ RoofCorrugated
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Wall
+
+
+
+
+
+
+
+ model://sydney_regatta/meshes/sydney_regatta.dae
+
+ TreeDiffuse
+
+
+
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta_shore.dae
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -527.49 153.855 0.425844 -0.1365 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -544.833 156.672 0.499025 -0.162625 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+
+
+
+
+ file://antenna/meshes/antenna.dae
+
+
+
+
+ 0 0 0.95 0 -0 0
+
+
+ 0.35
+ 1.9
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+
+
+
+
+ 0.04
+
+ 2.166e-05
+ 0
+ 0
+ 2166
+ 0
+ 2166
+
+ 0 0 0 0 -0 0
+
+
+
+
+ 0.0285
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0.0285
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.02 0 0 0
+
+
+ 0.0285
+
+
+
+
+ -545 60 0.03 0 -0 0
+
+
+ wamv
+ station_keeping
+ /vrx/station_keeping/rms_error
+ /vrx/station_keeping/pose_error
+ /vrx/station_keeping/goal
+ /vrx/task/info
+ /vrx/debug/contact
+ 1
+ -33.722718 150.674031 0.0
+ 10
+ 10
+ 300
+
+
+ wamv_external_pivot_joint
+
+
+ wamv_external_riser
+
+
+
+ 0.2 0.2 2.0
+ 0.5
+
+
+
+ 1
+
+ 0
+ 30
+ 1000 1000
+ 50 50
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+
+ 1
+ 0.1
+ 0.2
+ 0.2
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh.dae
+
+
+
+
+
+ -1
+
+
+ 0 0 -0.05 0 -0 0
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh_below.dae
+
+
+
+
+
+ -1
+
+ 0
+ 0
+ 0
+
+
+
+
+ wamv
+ wamv/base_link
+ .5 .5 .33
+
+ 240
+ 0.0
+ 0
+ 2
+ 10
+ 10
+ /vrx/debug/wind/speed
+ /vrx/debug/wind/direction
+
+
+
+
+ 12
+
+
+ 0
+ 0
+ 1 1 1 1
+ 0.7 0.7 0.7 1
+ 1
+
+ 0 0 -9.8
+ 6e-06 2.3e-05 -4.2e-05
+
+
+ 0.001
+ 1
+ 1000
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -516.604 172.729 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -529.133 179.258 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -523.155 194.622 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -521.42 204.495 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -506.943 187.384 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -504.149 207.427 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -512.488 225.125 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -526.202 208.204 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -530.604 226.659 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -531.874 208.458 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -546.573 227.925 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -545.897 207.646 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -560.364 227.188 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -559.776 207.284 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -570.274 226.896 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -568.569 206.11 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -525.787 219.148 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -517.48 203.744 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -552.382 211.633 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -538.696 218.192 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -564.573 220.866 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -512.341 188.564 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -521.185 185.681 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -512.608 212.857 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -532.341 222.817 0 0 -0 0
+
+
+ 185 431000000
+ 441 644514313
+ 1727055801 859517781
+ 185431
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 1 1 1
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545 60 0.02334 0 -0 0
+ 1 1 1
+
+ -545 60 0.02334 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 1 1 1
+
+ -540.743 146.687 1.66777 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -539.972 146.474 1.67444 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.727 146.128 1.67569 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.531 147.215 1.6548 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.049 147.325 1.65735 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 1 1 1
+
+ -537.569 146.021 1.6782 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.798 145.808 1.68302 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.553 145.462 1.68831 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.357 146.549 1.66717 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.875 146.659 1.66628 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 1 1 1
+
+ -534.497 145.103 1.71632 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.726 144.89 1.72031 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.481 144.545 1.72896 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.285 145.632 1.70558 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.803 145.741 1.70217 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -508.029 187.876 0.29263 0 -0 0
+ 1 1 1
+
+ -508.029 187.876 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -505.607 207.215 0.29263 0 -0 0
+ 1 1 1
+
+ -505.607 207.215 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -515.354 221.9 0.29263 0 -0 0
+ 1 1 1
+
+ -515.354 221.9 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -530.604 226.659 0.29263 0 -0 0
+ 1 1 1
+
+ -530.604 226.659 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -546.573 226.727 0.29263 0 -0 0
+ 1 1 1
+
+ -546.573 226.727 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -560.364 227.188 0.29263 0 -0 0
+ 1 1 1
+
+ -560.364 227.188 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -523.155 194.622 0.29263 0 -0 0
+ 1 1 1
+
+ -523.155 194.622 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -521.42 204.495 0.29263 0 -0 0
+ 1 1 1
+
+ -521.42 204.495 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.202 208.204 0.29263 0 -0 0
+ 1 1 1
+
+ -526.202 208.204 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -531.874 208.458 0.29263 0 -0 0
+ 1 1 1
+
+ -531.874 208.458 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545.897 207.646 0.29263 0 -0 0
+ 1 1 1
+
+ -545.897 207.646 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -559.776 207.284 0.29263 0 -0 0
+ 1 1 1
+
+ -559.776 207.284 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -514.942 171.587 0.29263 0 -0 0
+ 1 1 1
+
+ -514.942 171.587 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -529.133 179.258 0.29263 0 -0 0
+ 1 1 1
+
+ -529.133 179.258 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -570.274 226.896 0.29263 0 -0 0
+ 1 1 1
+
+ -570.274 226.896 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -568.569 206.11 0.29263 0 -0 0
+ 1 1 1
+
+ -568.569 206.11 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -525.787 219.148 0.142296 0 -0 0
+ 1 1 1
+
+ -525.787 219.148 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -517.48 203.744 0.142296 0 -0 0
+ 1 1 1
+
+ -517.48 203.744 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -552.382 211.633 0.142296 0 -0 0
+ 1 1 1
+
+ -552.382 211.633 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -538.696 218.192 0.142296 0 -0 0
+ 1 1 1
+
+ -538.696 218.192 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -564.573 220.866 0.142296 0 -0 0
+ 1 1 1
+
+ -564.573 220.866 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -512.341 188.564 0.142296 0 -0 0
+ 1 1 1
+
+ -512.341 188.564 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -521.185 185.681 0.142296 0 -0 0
+ 1 1 1
+
+ -521.185 185.681 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -512.608 212.857 0.142296 0 -0 0
+ 1 1 1
+
+ -512.608 212.857 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -4e-06 0 -0 0
+
+
+
+ -532.341 222.817 0.142296 0 -0 0
+ 1 1 1
+
+ -532.341 222.817 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -1.3e-05 0 -0 0
+ 0 0 -4.5e-05 0 -0 0
+
+
+
+ 0 0 0 0 -0 0
+ 1 1 1
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 1 1 1
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 1 1 1
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 1 1 1
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0.2 0 -0 0
+ 1 1 1
+
+ 0 0 0.2 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.771 167.357 -0.0992 -9.6e-05 -0.002848 1.00001
+ 1 1 1
+
+ -528.74 166.326 0.213432 -0.002082 -0.001946 1.7854
+ 0.001229 0.001915 -1.2e-05 5e-06 -3e-06 0
+ -2e-05 -3e-05 -0.000389 0.000215 -3e-05 -2e-06
+ -0.000296 -0.000454 -0.005833 0 -0 0
+
+
+ -528.68 166.056 -0.296478 -0.002082 -0.001946 1.7854
+ 0.001231 0.001917 -1.3e-05 5e-06 -3e-06 0
+ 3.5e-05 5.5e-05 -0.000428 0.000166 -0.000107 1e-06
+ 1.7e-05 2.7e-05 -0.000214 0 -0 0
+
+
+ -526.889 165.138 0.213643 0.001946 -0.002082 0.214616
+ 0.001229 0.001915 -1.2e-05 5e-06 -3e-06 0
+ -2e-05 -3.1e-05 -0.000389 0.000115 -0.000179 1e-06
+ -0.0003 -0.000459 -0.005842 0 -0 0
+
+
+ -527.16 165.08 -0.296304 0.001946 -0.002082 0.214616
+ 0.001231 0.001917 -1.3e-05 5e-06 -3e-06 0
+ 3.4e-05 5.5e-05 -0.000428 0.000166 -0.000107 -1e-06
+ 1.7e-05 2.7e-05 -0.000214 0 -0 0
+
+
+ -526.437 168.876 0.401653 0.001946 -0.002082 0.214616
+ 0.001229 0.001914 9e-06 5e-06 -3e-06 0
+ -3.9e-05 -6.2e-05 0.000281 0.000115 -0.000179 2e-06
+ -0.000591 -0.00093 0.004217 0 -0 0
+
+
+ -526.708 168.818 -0.108294 0.001946 -0.002082 0.214616
+ 0.00123 0.001916 8e-06 5e-06 -3e-06 0
+ 1.5e-05 2.3e-05 0.000243 0.000166 -0.000107 0
+ 7e-06 1.1e-05 0.000121 0 -0 0
+
+
+ -525.528 168.293 0.401577 -0.002082 -0.001946 1.7854
+ 0.001229 0.001914 9e-06 5e-06 -3e-06 0
+ -4e-05 -6.2e-05 0.000281 0.000215 -3e-05 -3e-06
+ -0.000593 -0.000932 0.004213 0 -0 0
+
+
+ -525.468 168.022 -0.108333 -0.002082 -0.001946 1.7854
+ 0.00123 0.001916 8e-06 5e-06 -3e-06 0
+ 1.5e-05 2.3e-05 0.000242 0.000166 -0.000107 0
+ 7e-06 1.1e-05 0.000121 0 -0 0
+
+
+ -526.734 167.971 1.2023 -0.00038 -0.002824 1.10001
+ 0.001226 0.00191 3e-06 5e-06 -3e-06 -1e-06
+ -0.00013 -0.000204 9.5e-05 0.000261 -0.000115 3.8e-05
+ -6.5e-05 -0.000102 4.7e-05 0 -0 0
+
+
+ -526.743 167.952 1.31012 -0.000547 -0.802824 1.1004
+ 0.001226 0.001909 3e-06 5e-06 -3e-06 -1e-06
+ -0.000136 -0.000214 9.5e-05 -4.9e-05 -0.000243 -0.000123
+ -6.8e-05 -0.000107 4.7e-05 0 -0 0
+
+
+ -526.771 167.357 -0.0992 -9.6e-05 -0.002848 1.00001
+ 0.00123 0.001916 0 5e-06 -3e-06 0
+ 1.1e-05 1.7e-05 -5e-06 -0.362719 -0.25911 -0.007289
+ 0.002001 0.003122 -0.000889 0 -0 0
+
+
+ -526.787 167.648 1.40146 -9.6e-05 -0.002848 1.00001
+ 0.001225 0.001908 1e-06 5e-06 -3e-06 0
+ -0.000146 -0.000228 3.9e-05 0.000166 -0.000107 -1e-06
+ -1.5e-05 -2.3e-05 4e-06 0 -0 0
+
+
+ -526.787 167.648 1.40146 -9.6e-05 -0.002848 1.00001
+ 0.001225 0.001908 1e-06 5e-06 -3e-06 0
+ -0.000146 -0.000228 3.9e-05 0.000166 -0.000107 0
+ -0.000146 -0.000228 3.9e-05 0 -0 0
+
+
+
+ 0 0 10 0 -0 0
+
+
+
+
diff --git a/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/opposite_u_shaped_test.world b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/opposite_u_shaped_test.world
new file mode 100644
index 000000000..3ec1ce8e9
--- /dev/null
+++ b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/opposite_u_shaped_test.world
@@ -0,0 +1,3882 @@
+
+
+
+ EARTH_WGS84
+ ENU
+ -33.7242
+ 150.68
+ 0
+ 0
+
+
+ 1
+ 0 0 10 0 -0 0
+ 0.8 0.8 0.8 1
+ 0.2 0.2 0.2 1
+
+ 1000
+ 0.9
+ 0.01
+ 0.001
+
+ -0.5 0.1 -0.9
+
+ 0
+ 0
+ 0
+
+
+
+
+ -465.03 178.5 18.9801 0 0.248344 2.93686
+ orbit
+ perspective
+
+
+
+ 0 0 0.2 0 -0 0
+ 1
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Terrain
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ ConcreteDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ DockDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ MetalGalvanized
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Dock
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Windows_Dark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ RoofCorrugated
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Wall
+
+
+
+
+
+
+
+ model://sydney_regatta/meshes/sydney_regatta.dae
+
+ TreeDiffuse
+
+
+
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta_shore.dae
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -527.49 153.855 0.425844 -0.1365 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -544.833 156.672 0.499025 -0.162625 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+
+
+
+
+ file://antenna/meshes/antenna.dae
+
+
+
+
+ 0 0 0.95 0 -0 0
+
+
+ 0.35
+ 1.9
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+
+
+
+
+ 0.04
+
+ 2.166e-05
+ 0
+ 0
+ 2166
+ 0
+ 2166
+
+ 0 0 0 0 -0 0
+
+
+
+
+ 0.0285
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0.0285
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.02 0 0 0
+
+
+ 0.0285
+
+
+
+
+ -545 60 0.03 0 -0 0
+
+
+ wamv
+ station_keeping
+ /vrx/station_keeping/rms_error
+ /vrx/station_keeping/pose_error
+ /vrx/station_keeping/goal
+ /vrx/task/info
+ /vrx/debug/contact
+ 1
+ -33.722718 150.674031 0.0
+ 10
+ 10
+ 300
+
+
+ wamv_external_pivot_joint
+
+
+ wamv_external_riser
+
+
+
+ 0.2 0.2 2.0
+ 0.5
+
+
+
+ 1
+
+ 0
+ 30
+ 1000 1000
+ 50 50
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+
+ 1
+ 0.1
+ 0.2
+ 0.2
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh.dae
+
+
+
+
+
+ -1
+
+
+ 0 0 -0.05 0 -0 0
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh_below.dae
+
+
+
+
+
+ -1
+
+ 0
+ 0
+ 0
+
+
+
+
+ wamv
+ wamv/base_link
+ .5 .5 .33
+
+ 240
+ 0.0
+ 0
+ 2
+ 10
+ 10
+ /vrx/debug/wind/speed
+ /vrx/debug/wind/direction
+
+
+
+
+ 12
+
+
+ 0
+ 0
+ 1 1 1 1
+ 0.7 0.7 0.7 1
+ 1
+
+ 0 0 -9.8
+ 6e-06 2.3e-05 -4.2e-05
+
+
+ 0.001
+ 1
+ 1000
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -513.854 172.45 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -526.852 173.431 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -515.871 181.913 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -533.7 179.357 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -545.062 186.574 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -553.263 198.37 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -544.414 207.382 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -528.485 210.314 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -511.175 208.862 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -525.052 186.55 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -532.116 193.856 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -526.307 196.568 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -515.955 198.213 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -504.569 197.429 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -496.057 198.621 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -502.447 208.77 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -526.693 178.439 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -523.758 183.582 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -541.49 189.801 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -546.231 198.159 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -532.035 198.198 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -526.845 205.78 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -516.126 201.721 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -512.76 208.391 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -538.814 183.568 0 0 -0 0
+
+
+ 200 837000000
+ 435 540859954
+ 1726450699 625350457
+ 200837
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 1 1 1
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545 60 0.02334 0 -0 0
+ 1 1 1
+
+ -545 60 0.02334 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 1 1 1
+
+ -540.743 146.687 1.66777 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -539.972 146.474 1.67444 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.727 146.128 1.67569 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.531 147.215 1.6548 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.049 147.325 1.65735 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 1 1 1
+
+ -537.569 146.021 1.6782 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.798 145.808 1.68302 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.553 145.462 1.68831 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.357 146.549 1.66717 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.875 146.659 1.66628 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 1 1 1
+
+ -534.497 145.103 1.71632 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.726 144.89 1.72031 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.481 144.545 1.72896 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.285 145.632 1.70558 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.803 145.741 1.70217 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -518.336 179.261 0.29263 0 -0 0
+ 1 1 1
+
+ -518.336 179.261 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -525.052 186.55 0.29263 0 -0 0
+ 1 1 1
+
+ -525.052 186.55 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -532.116 193.856 0.29263 0 -0 0
+ 1 1 1
+
+ -532.116 193.856 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.307 196.568 0.29263 0 -0 0
+ 1 1 1
+
+ -526.307 196.568 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -515.955 198.213 0.29263 0 -0 0
+ 1 1 1
+
+ -515.955 198.213 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -504.569 198.871 0.29263 0 -0 0
+ 1 1 1
+
+ -504.569 198.871 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.223 178.196 0.29263 0 -0 0
+ 1 1 1
+
+ -537.223 178.196 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545.062 186.574 0.29263 0 -0 0
+ 1 1 1
+
+ -545.062 186.574 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -553.263 198.37 0.29263 0 -0 0
+ 1 1 1
+
+ -553.263 198.37 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.414 207.382 0.29263 0 -0 0
+ 1 1 1
+
+ -544.414 207.382 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -528.485 210.314 0.29263 0 -0 0
+ 1 1 1
+
+ -528.485 210.314 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -511.175 210.271 0.29263 0 -0 0
+ 1 1 1
+
+ -511.175 210.271 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -513.854 172.45 0.29263 0 -0 0
+ 1 1 1
+
+ -513.854 172.45 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -529.803 173.03 0.29263 0 -0 0
+ 1 1 1
+
+ -529.803 173.03 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -496.057 198.621 0.29263 0 -0 0
+ 1 1 1
+
+ -496.057 198.621 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -502.447 208.77 0.29263 0 -0 0
+ 1 1 1
+
+ -502.447 208.77 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -523.696 178.429 0.142296 0 -0 0
+ 1 1 1
+
+ -523.696 178.429 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -525.679 183.539 0.142296 0 -0 0
+ 1 1 1
+
+ -525.679 183.539 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -541.49 189.801 0.142296 0 -0 0
+ 1 1 1
+
+ -541.49 189.801 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -546.231 198.159 0.142296 0 -0 0
+ 1 1 1
+
+ -546.231 198.159 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -532.035 198.198 0.142296 0 -0 0
+ 1 1 1
+
+ -532.035 198.198 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.845 205.78 0.142296 0 -0 0
+ 1 1 1
+
+ -526.845 205.78 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -516.126 201.721 0.142296 0 -0 0
+ 1 1 1
+
+ -516.126 201.721 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -512.76 208.391 0.142296 0 -0 0
+ 1 1 1
+
+ -512.76 208.391 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -538.814 183.568 0.142296 0 -0 0
+ 1 1 1
+
+ -538.814 183.568 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 1e-06 0 -0 0
+
+
+
+ -1.8602 -0.426318 0 0 -0 0
+ 1 1 1
+
+ -1.8602 -0.426318 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 1 1 1
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 1 1 1
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 1 1 1
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0.2 0 -0 0
+ 1 1 1
+
+ 0 0 0.2 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.752 167.387 -0.099201 -9.6e-05 -0.00285 1.00001
+ 1 1 1
+
+ -528.721 166.356 0.213428 -0.002083 -0.001948 1.7854
+ 0.001231 0.001917 2.2e-05 -1e-05 6e-06 0
+ 1e-06 2e-06 1.7e-05 4.5e-05 8.4e-05 -3e-06
+ 1e-05 2.6e-05 0.000262 0 -0 0
+
+
+ -528.661 166.085 -0.296483 -0.002083 -0.001948 1.7854
+ 0.001228 0.001912 2.5e-05 -1e-05 6e-06 0
+ -1e-06 -2e-06 1.9e-05 -8e-06 4e-06 0
+ -1e-06 -1e-06 1e-05 0 -0 0
+
+
+ -526.87 165.167 0.213639 0.001947 -0.002083 0.214616
+ 0.001231 0.001917 2.2e-05 -1e-05 6e-06 0
+ 1e-06 2e-06 1.9e-05 -5.8e-05 -6.9e-05 3e-06
+ 1.1e-05 2.7e-05 0.000289 0 -0 0
+
+
+ -527.141 165.109 -0.29631 0.001947 -0.002083 0.214616
+ 0.001228 0.001912 2.5e-05 -1e-05 6e-06 0
+ -1e-06 -2e-06 2.1e-05 -8e-06 4e-06 0
+ -1e-06 -1e-06 1e-05 0 -0 0
+
+
+ -526.418 168.906 0.401657 0.001947 -0.002083 0.214616
+ 0.001232 0.001919 -1.6e-05 -1e-05 6e-06 0
+ 1e-06 3e-06 -1.1e-05 -5.8e-05 -6.9e-05 3e-06
+ 2e-05 4.9e-05 -0.00017 0 -0 0
+
+
+ -526.689 168.848 -0.108292 0.001947 -0.002083 0.214616
+ 0.001229 0.001914 -1.4e-05 -1e-05 6e-06 0
+ -1e-06 -1e-06 -1e-05 -8e-06 4e-06 0
+ -0 -0 -5e-06 0 -0 0
+
+
+ -525.509 168.322 0.401581 -0.002083 -0.001948 1.7854
+ 0.001232 0.001919 -1.6e-05 -1e-05 6e-06 0
+ 1e-06 3e-06 -1e-05 4.5e-05 8.4e-05 -3e-06
+ 2e-05 5e-05 -0.000157 0 -0 0
+
+
+ -525.449 168.052 -0.10833 -0.002083 -0.001948 1.7854
+ 0.001229 0.001914 -1.4e-05 -1e-05 6e-06 0
+ -1e-06 -1e-06 -9e-06 -8e-06 4e-06 0
+ -0 -0 -4e-06 0 -0 0
+
+
+ -526.715 168 1.2023 -0.00038 -0.002826 1.10001
+ 0.001237 0.001927 -6e-06 -1e-05 6e-06 3e-06
+ 7.3e-05 -2.5e-05 -3e-06 -2.2e-05 -4e-06 0.003838
+ 3.7e-05 -1.3e-05 -1e-06 0 -0 0
+
+
+ -526.724 167.982 1.31012 -0.000547 -0.802826 1.1004
+ 0.001238 0.001928 -6e-06 -1e-05 6e-06 3e-06
+ 7.5e-05 -2.5e-05 -3e-06 0.005995 0.011789 0.017537
+ 3.7e-05 -1.3e-05 -1e-06 0 -0 0
+
+
+ -526.752 167.387 -0.099201 -9.6e-05 -0.00285 1.00001
+ 0.001229 0.001914 0 -1e-05 6e-06 0
+ -1e-06 -0 2e-06 -0.362989 -0.259057 -0.007291
+ -9.7e-05 -7.1e-05 0.000287 0 -0 0
+
+
+ -526.768 167.677 1.40146 -9.6e-05 -0.00285 1.00001
+ 0.001238 0.001929 -2e-06 -1e-05 6e-06 0
+ 5e-06 1.1e-05 -0 -8e-06 4e-06 1e-06
+ 1e-06 1e-06 -0 0 -0 0
+
+
+ -526.768 167.677 1.40146 -9.6e-05 -0.00285 1.00001
+ 0.001238 0.001929 -2e-06 -1e-05 6e-06 0
+ 5e-06 1.1e-05 -0 -8e-06 4e-06 -1e-06
+ 5e-06 1.1e-05 -0 0 -0 0
+
+
+
+ 0 0 10 0 -0 0
+
+
+
+
diff --git a/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/right_L_path_test.world b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/right_L_path_test.world
new file mode 100644
index 000000000..30811290f
--- /dev/null
+++ b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/right_L_path_test.world
@@ -0,0 +1,3882 @@
+
+
+
+ EARTH_WGS84
+ ENU
+ -33.7242
+ 150.68
+ 0
+ 0
+
+
+ 1
+ 0 0 10 0 -0 0
+ 0.8 0.8 0.8 1
+ 0.2 0.2 0.2 1
+
+ 1000
+ 0.9
+ 0.01
+ 0.001
+
+ -0.5 0.1 -0.9
+
+ 0
+ 0
+ 0
+
+
+
+
+ -484.849 180.005 146.154 3.14159 1.57079 3.14159
+ orbit
+ perspective
+
+
+
+ 0 0 0.2 0 -0 0
+ 1
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Terrain
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ ConcreteDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ DockDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ MetalGalvanized
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Dock
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Windows_Dark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ RoofCorrugated
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Wall
+
+
+
+
+
+
+
+ model://sydney_regatta/meshes/sydney_regatta.dae
+
+ TreeDiffuse
+
+
+
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta_shore.dae
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -527.49 153.855 0.425844 -0.1365 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -544.833 156.672 0.499025 -0.162625 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+
+
+
+
+ file://antenna/meshes/antenna.dae
+
+
+
+
+ 0 0 0.95 0 -0 0
+
+
+ 0.35
+ 1.9
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+
+
+
+
+ 0.04
+
+ 2.166e-05
+ 0
+ 0
+ 2166
+ 0
+ 2166
+
+ 0 0 0 0 -0 0
+
+
+
+
+ 0.0285
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0.0285
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.02 0 0 0
+
+
+ 0.0285
+
+
+
+
+ -545 60 0.03 0 -0 0
+
+
+ wamv
+ station_keeping
+ /vrx/station_keeping/rms_error
+ /vrx/station_keeping/pose_error
+ /vrx/station_keeping/goal
+ /vrx/task/info
+ /vrx/debug/contact
+ 1
+ -33.722718 150.674031 0.0
+ 10
+ 10
+ 300
+
+
+ wamv_external_pivot_joint
+
+
+ wamv_external_riser
+
+
+
+ 0.2 0.2 2.0
+ 0.5
+
+
+
+ 1
+
+ 0
+ 30
+ 1000 1000
+ 50 50
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+
+ 1
+ 0.1
+ 0.2
+ 0.2
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh.dae
+
+
+
+
+
+ -1
+
+
+ 0 0 -0.05 0 -0 0
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh_below.dae
+
+
+
+
+
+ -1
+
+ 0
+ 0
+ 0
+
+
+
+
+ wamv
+ wamv/base_link
+ .5 .5 .33
+
+ 240
+ 0.0
+ 0
+ 2
+ 10
+ 10
+ /vrx/debug/wind/speed
+ /vrx/debug/wind/direction
+
+
+
+
+ 12
+
+
+ 0
+ 0
+ 1 1 1 1
+ 0.7 0.7 0.7 1
+ 1
+
+ 0 0 -9.8
+ 6e-06 2.3e-05 -4.2e-05
+
+
+ 0.001
+ 1
+ 1000
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -512.57 169.665 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -529.689 180.009 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -523.968 197.937 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -516.636 214.26 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -506.362 190.705 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -502.06 203.905 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -495.185 226.039 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -494.486 203.905 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -485.699 200.43 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -473.035 190.309 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -460.645 178.979 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -479.316 217.328 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -462.273 205.355 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -448.875 192.103 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -439.775 180.755 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -449.345 166.985 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -518.839 181.834 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -515.092 203.959 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -508.535 192.362 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -504.253 216.315 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -476.418 205.008 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -461.653 198.852 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -489.443 206.346 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -457.014 184.332 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -445.283 179.046 0 0 -0 0
+
+
+ 165 648000000
+ 344 788944934
+ 1727056218 566502673
+ 165648
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 1 1 1
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545 60 0.02334 0 -0 0
+ 1 1 1
+
+ -545 60 0.02334 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 1 1 1
+
+ -540.743 146.687 1.66777 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -539.972 146.474 1.67444 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.727 146.128 1.67569 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.531 147.215 1.6548 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.049 147.325 1.65735 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 1 1 1
+
+ -537.569 146.021 1.6782 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.798 145.808 1.68302 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.553 145.462 1.68831 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.357 146.549 1.66717 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.875 146.659 1.66628 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 1 1 1
+
+ -534.497 145.103 1.71632 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.726 144.89 1.72031 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.481 144.545 1.72896 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.285 145.632 1.70558 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.803 145.741 1.70217 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -506.362 190.705 0.29263 0 -0 0
+ 1 1 1
+
+ -506.362 190.705 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -502.06 203.905 0.29263 0 -0 0
+ 1 1 1
+
+ -502.06 203.905 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -494.486 203.905 0.29263 0 -0 0
+ 1 1 1
+
+ -494.486 203.905 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -485.699 200.43 0.29263 0 -0 0
+ 1 1 1
+
+ -485.699 200.43 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -473.035 190.309 0.29263 0 -0 0
+ 1 1 1
+
+ -473.035 190.309 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -460.645 178.979 0.29263 0 -0 0
+ 1 1 1
+
+ -460.645 178.979 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -523.968 197.937 0.29263 0 -0 0
+ 1 1 1
+
+ -523.968 197.937 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -516.636 214.26 0.29263 0 -0 0
+ 1 1 1
+
+ -516.636 214.26 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -495.98 223.072 0.29263 0 -0 0
+ 1 1 1
+
+ -495.98 223.072 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -479.316 217.328 0.29263 0 -0 0
+ 1 1 1
+
+ -479.316 217.328 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -462.273 205.355 0.29263 0 -0 0
+ 1 1 1
+
+ -462.273 205.355 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -448.875 192.103 0.29263 0 -0 0
+ 1 1 1
+
+ -448.875 192.103 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -513.365 171.222 0.29263 0 -0 0
+ 1 1 1
+
+ -513.365 171.222 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -529.689 180.009 0.29263 0 -0 0
+ 1 1 1
+
+ -529.689 180.009 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -438.279 180.747 0.29263 0 -0 0
+ 1 1 1
+
+ -438.279 180.747 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -449.345 166.985 0.29263 0 -0 0
+ 1 1 1
+
+ -449.345 166.985 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -518.839 181.834 0.142296 0 -0 0
+ 1 1 1
+
+ -518.839 181.834 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -515.092 203.959 0.142296 0 -0 0
+ 1 1 1
+
+ -515.092 203.959 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 1e-06 0 -0 0
+
+
+
+ -508.535 192.362 0.142296 0 -0 0
+ 1 1 1
+
+ -508.535 192.362 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 1e-06 0 -0 0
+
+
+
+ -504.253 216.315 0.142296 0 -0 0
+ 1 1 1
+
+ -504.253 216.315 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -4e-06 0 -0 0
+
+
+
+ -476.418 205.008 0.142296 0 -0 0
+ 1 1 1
+
+ -476.418 205.008 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 3e-06 0 -0 0
+ 0 0 1.1e-05 0 -0 0
+
+
+
+ -461.653 198.852 0.142296 0 -0 0
+ 1 1 1
+
+ -461.653 198.852 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -7e-06 0 -0 0
+ 0 0 -2.5e-05 0 -0 0
+
+
+
+ -489.443 206.346 0.142296 0 -0 0
+ 1 1 1
+
+ -489.443 206.346 0.142296 0 -0 0
+ 0 0 1e-06 0 -0 0
+ 0 0 -1.7e-05 0 -0 0
+ 0 0 -5.9e-05 0 -0 0
+
+
+
+ -457.014 184.332 0.142296 0 -0 0
+ 1 1 1
+
+ -457.014 184.332 0.142296 0 -0 0
+ 0 0 -4e-06 0 -0 0
+ 0 0 -1.1e-05 0 -0 0
+ 0 0 -3.8e-05 0 -0 0
+
+
+
+ -445.283 179.046 0.142296 0 -0 0
+ 1 1 1
+
+ -445.283 179.046 0.142296 0 -0 0
+ 0 0 7.7e-05 0 -0 0
+ 0 0 -0.000255 0 -0 0
+ 0 0 -0.000891 0 -0 0
+
+
+
+ 0 0 0 0 -0 0
+ 1 1 1
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 1 1 1
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 1 1 1
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 1 1 1
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0.2 0 -0 0
+ 1 1 1
+
+ 0 0 0.2 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.795 167.32 -0.0992 -9.6e-05 -0.002846 1.00001
+ 1 1 1
+
+ -528.764 166.289 0.213436 -0.00208 -0.001944 1.7854
+ 0.001227 0.00191 -6.7e-05 2.9e-05 -1.8e-05 0
+ -3.7e-05 -5.5e-05 -0.00071 0.000348 -0.000121 -1e-06
+ -0.000549 -0.000831 -0.010646 0 -0 0
+
+
+ -528.704 166.018 -0.296474 -0.00208 -0.001944 1.7854
+ 0.001236 0.001925 -7.3e-05 2.9e-05 -1.8e-05 0
+ 6.3e-05 9.9e-05 -0.00078 0.000302 -0.000194 2e-06
+ 3.2e-05 4.9e-05 -0.00039 0 -0 0
+
+
+ -526.913 165.1 0.213647 0.001944 -0.00208 0.214616
+ 0.001227 0.00191 -6.7e-05 2.9e-05 -1.8e-05 0
+ -3.7e-05 -5.6e-05 -0.000709 0.00025 -0.000266 0
+ -0.000555 -0.00084 -0.010633 0 -0 0
+
+
+ -527.184 165.042 -0.2963 0.001944 -0.00208 0.214616
+ 0.001236 0.001925 -7.3e-05 2.9e-05 -1.8e-05 0
+ 6.2e-05 9.9e-05 -0.000779 0.000302 -0.000194 -3e-06
+ 3.1e-05 4.9e-05 -0.00039 0 -0 0
+
+
+ -526.461 168.839 0.401651 0.001944 -0.00208 0.214616
+ 0.001223 0.001905 4.9e-05 2.9e-05 -1.8e-05 0
+ -7.3e-05 -0.000113 0.000509 0.00025 -0.000266 2e-06
+ -0.001089 -0.001693 0.007629 0 -0 0
+
+
+ -526.732 168.781 -0.108297 0.001944 -0.00208 0.214616
+ 0.001233 0.00192 4.2e-05 2.9e-05 -1.8e-05 0
+ 2.7e-05 4.1e-05 0.000438 0.000302 -0.000194 0
+ 1.3e-05 2.1e-05 0.000219 0 -0 0
+
+
+ -525.552 168.255 0.401575 -0.00208 -0.001944 1.7854
+ 0.001223 0.001905 4.9e-05 2.9e-05 -1.8e-05 0
+ -7.3e-05 -0.000113 0.000509 0.000348 -0.000121 -3e-06
+ -0.001091 -0.001697 0.007636 0 -0 0
+
+
+ -525.492 167.985 -0.108335 -0.00208 -0.001944 1.7854
+ 0.001233 0.00192 4.2e-05 2.9e-05 -1.8e-05 0
+ 2.7e-05 4.1e-05 0.000439 0.000302 -0.000194 0
+ 1.3e-05 2e-05 0.000219 0 -0 0
+
+
+ -526.758 167.933 1.2023 -0.00038 -0.002822 1.10001
+ 0.001208 0.001882 1.8e-05 2.9e-05 -1.8e-05 3e-06
+ -0.00017 -0.000405 0.00017 0.000464 -0.000218 0.00384
+ -8.5e-05 -0.000202 8.5e-05 0 -0 0
+
+
+ -526.767 167.915 1.31012 -0.000547 -0.802822 1.1004
+ 0.001207 0.001879 1.7e-05 2.9e-05 -1.8e-05 3e-06
+ -0.00018 -0.000423 0.00017 0.005796 0.011123 0.016996
+ -9e-05 -0.000211 8.5e-05 0 -0 0
+
+
+ -526.795 167.32 -0.0992 -9.6e-05 -0.002846 1.00001
+ 0.001232 0.001919 -1e-06 2.9e-05 -1.8e-05 0
+ 1.9e-05 3.1e-05 -1.1e-05 -0.362508 -0.259154 -0.007287
+ 0.003538 0.005596 -0.001965 0 -0 0
+
+
+ -526.811 167.61 1.40146 -9.6e-05 -0.002846 1.00001
+ 0.001205 0.001876 7e-06 2.9e-05 -1.8e-05 0
+ -0.000267 -0.000415 6.9e-05 0.000302 -0.000194 0
+ -2.7e-05 -4.1e-05 7e-06 0 -0 0
+
+
+ -526.811 167.61 1.40146 -9.6e-05 -0.002846 1.00001
+ 0.001205 0.001876 7e-06 2.9e-05 -1.8e-05 0
+ -0.000267 -0.000415 6.9e-05 0.000302 -0.000194 -1e-06
+ -0.000267 -0.000415 6.9e-05 0 -0 0
+
+
+
+ 0 0 10 0 -0 0
+
+
+
+
diff --git a/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/sharp_left_test.world b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/sharp_left_test.world
new file mode 100644
index 000000000..4cff8ea79
--- /dev/null
+++ b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/sharp_left_test.world
@@ -0,0 +1,3803 @@
+
+
+
+ EARTH_WGS84
+ ENU
+ -33.7242
+ 150.68
+ 0
+ 0
+
+
+ 1
+ 0 0 10 0 -0 0
+ 0.8 0.8 0.8 1
+ 0.2 0.2 0.2 1
+
+ 1000
+ 0.9
+ 0.01
+ 0.001
+
+ -0.5 0.1 -0.9
+
+ 0
+ 0
+ 0
+
+
+
+
+ -509.81 173.543 119.525 -0 1.2418 2.50888
+ orbit
+ perspective
+
+
+
+ 0 0 0.2 0 -0 0
+ 1
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Terrain
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ ConcreteDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ DockDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ MetalGalvanized
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Dock
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Windows_Dark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ RoofCorrugated
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Wall
+
+
+
+
+
+
+
+ model://sydney_regatta/meshes/sydney_regatta.dae
+
+ TreeDiffuse
+
+
+
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta_shore.dae
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -527.49 153.855 0.425844 -0.1365 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -544.833 156.672 0.499025 -0.162625 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+
+
+
+
+ file://antenna/meshes/antenna.dae
+
+
+
+
+ 0 0 0.95 0 -0 0
+
+
+ 0.35
+ 1.9
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+
+
+
+
+ 0.04
+
+ 2.166e-05
+ 0
+ 0
+ 2166
+ 0
+ 2166
+
+ 0 0 0 0 -0 0
+
+
+
+
+ 0.0285
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0.0285
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.02 0 0 0
+
+
+ 0.0285
+
+
+
+
+ -545 60 0.03 0 -0 0
+
+
+ wamv
+ station_keeping
+ /vrx/station_keeping/rms_error
+ /vrx/station_keeping/pose_error
+ /vrx/station_keeping/goal
+ /vrx/task/info
+ /vrx/debug/contact
+ 1
+ -33.722718 150.674031 0.0
+ 10
+ 10
+ 300
+
+
+ wamv_external_pivot_joint
+
+
+ wamv_external_riser
+
+
+
+ 0.2 0.2 2.0
+ 0.5
+
+
+
+ 1
+
+ 0
+ 30
+ 1000 1000
+ 50 50
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+
+ 1
+ 0.1
+ 0.2
+ 0.2
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh.dae
+
+
+
+
+
+ -1
+
+
+ 0 0 -0.05 0 -0 0
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh_below.dae
+
+
+
+
+
+ -1
+
+ 0
+ 0
+ 0
+
+
+
+
+ wamv
+ wamv/base_link
+ .5 .5 .33
+
+ 240
+ 0.0
+ 0
+ 2
+ 10
+ 10
+ /vrx/debug/wind/speed
+ /vrx/debug/wind/direction
+
+
+
+
+ 12
+
+
+ 0
+ 0
+ 1 1 1 1
+ 0.7 0.7 0.7 1
+ 1
+
+ 0 0 -9.8
+ 6e-06 2.3e-05 -4.2e-05
+
+
+ 0.001
+ 1
+ 1000
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -512.865 174.42 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -534.757 180.045 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -520.169 194.084 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -476.392 160.515 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -504.951 182.227 0 0 -0 0
+
+
+ 288 563000000
+ 7 210985954
+ 1727196441 575993336
+ 6953
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 1 1 1
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545 60 0.02334 0 -0 0
+ 1 1 1
+
+ -545 60 0.02334 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 1 1 1
+
+ -540.743 146.687 1.66777 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -539.972 146.474 1.67444 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.727 146.128 1.67569 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.531 147.215 1.6548 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.049 147.325 1.65735 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 1 1 1
+
+ -537.569 146.021 1.6782 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.798 145.808 1.68302 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.553 145.462 1.68831 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.357 146.549 1.66717 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.875 146.659 1.66628 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 1 1 1
+
+ -534.497 145.103 1.71632 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.726 144.89 1.72031 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.481 144.545 1.72896 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.285 145.632 1.70558 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.803 145.741 1.70217 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -508.709 194.579 0.29263 0 -0 0
+ 1 1 1
+
+ -508.709 194.579 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -509.608 216.516 0.29263 0 -0 0
+ 1 1 1
+
+ -509.608 216.516 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -529.223 243.578 0.29263 0 -0 0
+ 1 1 1
+
+ -529.223 243.578 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -516.052 230.096 0.29263 0 -0 0
+ 1 1 1
+
+ -516.052 230.096 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -539.699 251.148 0.29263 0 -0 0
+ 1 1 1
+
+ -539.699 251.148 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -522.264 237.706 0.29263 0 -0 0
+ 1 1 1
+
+ -522.264 237.706 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -530.708 194.688 0.29263 0 -0 0
+ 1 1 1
+
+ -530.708 194.688 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -531.951 207.383 0.29263 0 -0 0
+ 1 1 1
+
+ -531.951 207.383 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.43 215.651 0.29263 0 -0 0
+ 1 1 1
+
+ -540.43 215.651 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -548.555 220.865 0.29263 0 -0 0
+ 1 1 1
+
+ -548.555 220.865 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -558.902 223.835 0.29263 0 -0 0
+ 1 1 1
+
+ -558.902 223.835 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -554.233 222.364 0.29263 0 -0 0
+ 1 1 1
+
+ -554.233 222.364 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -512.865 174.42 0.29263 0 -0 0
+ 1 1 1
+
+ -512.865 174.42 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -531.896 181.491 0.29263 0 -0 0
+ 1 1 1
+
+ -531.896 181.491 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -565.924 224.031 0.29263 0 -0 0
+ 1 1 1
+
+ -565.924 224.031 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -552.056 254.454 0.29263 0 -0 0
+ 1 1 1
+
+ -552.056 254.454 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -525.253 202.243 0.142296 0 -0 0
+ 1 1 1
+
+ -525.253 202.243 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -524.956 219.616 0.142296 0 -0 0
+ 1 1 1
+
+ -524.956 219.616 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.209 216.664 0.142296 0 -0 0
+ 1 1 1
+
+ -537.209 216.664 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534 230 0.142296 0 -0 0
+ 1 1 1
+
+ -534 230 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -546 227 0.142296 0 -0 0
+ 1 1 1
+
+ -546 227 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -538 240 0.142296 0 -0 0
+ 1 1 1
+
+ -538 240 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -547 237 0.142296 0 -0 0
+ 1 1 1
+
+ -547 237 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -557 233 0.142296 0 -0 0
+ 1 1 1
+
+ -557 233 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0 0 -0 0
+ 1 1 1
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 1 1 1
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 1 1 1
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 1 1 1
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0.2 0 -0 0
+ 1 1 1
+
+ 0 0 0.2 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.644 167.555 -0.0992 -9.2e-05 -0.002841 1.00001
+ 1 1 1
+
+ -528.614 166.524 0.21345 -0.002074 -0.001944 1.7854
+ 0.001251 0.001924 0.000259 -3.9e-05 0.000109 -1e-06
+ -0.000249 1.8e-05 -0.002623 0.000164 -0.001219 6e-06
+ -0.003729 0.000267 -0.039351 0 -0 0
+
+
+ -528.554 166.254 -0.29646 -0.002074 -0.001944 1.7854
+ 0.001195 0.001904 0.000263 -3.9e-05 0.000109 -1e-06
+ 0.000393 7.1e-05 -0.002576 0.000107 -0.00127 -2.2e-05
+ 0.000197 3.6e-05 -0.001288 0 -0 0
+
+
+ -526.762 165.336 0.213652 0.001944 -0.002074 0.214619
+ 0.001253 0.001926 0.000103 -3.9e-05 0.000109 1e-06
+ -0.000271 -1.7e-05 -0.0004 5e-05 -0.001343 9e-06
+ -0.00407 -0.000258 -0.006003 0 -0 0
+
+
+ -527.033 165.278 -0.296294 0.001943 -0.002074 0.214619
+ 0.001197 0.001906 0.000135 -3.9e-05 0.000109 1e-06
+ 0.000375 4.4e-05 -0.00075 0.000107 -0.00127 -2.5e-05
+ 0.000187 2.2e-05 -0.000375 0 -0 0
+
+
+ -526.311 169.074 0.401646 0.001944 -0.002074 0.214619
+ 0.001268 0.001934 -9.2e-05 -3.9e-05 0.000109 1e-06
+ -0.000439 -4.6e-05 0.000573 5e-05 -0.001343 1.2e-05
+ -0.006592 -0.000687 0.008593 0 -0 0
+
+
+ -526.582 169.016 -0.1083 0.001943 -0.002074 0.214619
+ 0.001212 0.001914 -6e-05 -3.9e-05 0.000109 1e-06
+ 0.000207 1.4e-05 0.000223 0.000107 -0.00127 -2.1e-05
+ 0.000103 7e-06 0.000111 0 -0 0
+
+
+ -525.402 168.491 0.401565 -0.002074 -0.001944 1.7854
+ 0.001269 0.001936 -0.000168 -3.9e-05 0.000109 1e-06
+ -0.00045 -6.3e-05 0.001664 0.000163 -0.00122 7e-06
+ -0.006755 -0.000945 0.024964 0 -0 0
+
+
+ -525.342 168.22 -0.108344 -0.002074 -0.001944 1.7854
+ 0.001213 0.001916 -0.000164 -3.9e-05 0.000109 1e-06
+ 0.000192 -1e-05 0.001712 0.000107 -0.00127 -2.1e-05
+ 9.6e-05 -5e-06 0.000856 0 -0 0
+
+
+ -526.607 168.169 1.2023 -0.000375 -0.002818 1.10001
+ 0.001357 0.001965 -2.4e-05 -3.9e-05 0.000109 4e-06
+ -0.001468 -0.000166 8.6e-05 0.000339 -0.000928 0.003822
+ -0.000734 -8.3e-05 4.3e-05 0 -0 0
+
+
+ -526.617 168.15 1.31012 -0.00054 -0.802818 1.1004
+ 0.001369 0.001969 -2.2e-05 -3.9e-05 0.000109 4e-06
+ -0.00154 -0.000173 8.6e-05 0.004277 0.007108 0.013561
+ -0.00077 -8.6e-05 4.3e-05 0 -0 0
+
+
+ -526.644 167.555 -0.0992 -9.2e-05 -0.002841 1.00001
+ 0.001215 0.001914 4e-06 -3.9e-05 0.000109 1e-06
+ 0.000135 1.1e-05 -3e-06 -0.362239 -0.259412 -0.007289
+ 0.024623 0.00203 -0.000619 0 -0 0
+
+
+ -526.66 167.846 1.40146 -9.2e-05 -0.002841 1.00001
+ 0.001379 0.001973 -6e-06 -3.9e-05 0.000109 1e-06
+ -0.001732 -0.000146 -2e-06 0.000103 -0.001276 -2.1e-05
+ -0.000173 -1.5e-05 -0 0 -0 0
+
+
+ -526.66 167.846 1.40146 -9.2e-05 -0.002841 1.00001
+ 0.001379 0.001973 -6e-06 -3.9e-05 0.000109 1e-06
+ -0.001732 -0.000146 -2e-06 0.000107 -0.00127 -1.9e-05
+ -0.001732 -0.000146 -2e-06 0 -0 0
+
+
+
+ 0 0 10 0 -0 0
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -531.951 207.383 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -509.608 216.516 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -525.253 202.243 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -524.956 219.616 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -537.209 216.664 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -534 230 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -546 227 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -538 240 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -547 237 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -557 233 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -552.056 254.454 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -516.097 227.963 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -516.052 230.096 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -539.699 251.148 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -522.264 237.706 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -540.43 215.651 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -548.555 220.865 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -558.902 223.835 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -554.233 222.364 0.29263 0 -0 0
+
+
+
diff --git a/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/sharp_right_test.world b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/sharp_right_test.world
new file mode 100644
index 000000000..564b16f42
--- /dev/null
+++ b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/sharp_right_test.world
@@ -0,0 +1,3882 @@
+
+
+
+ EARTH_WGS84
+ ENU
+ -33.7242
+ 150.68
+ 0
+ 0
+
+
+ 1
+ 0 0 10 0 -0 0
+ 0.8 0.8 0.8 1
+ 0.2 0.2 0.2 1
+
+ 1000
+ 0.9
+ 0.01
+ 0.001
+
+ -0.5 0.1 -0.9
+
+ 0
+ 0
+ 0
+
+
+
+
+ -494.622 151.416 111.682 3.14159 1.57079 3.14159
+ orbit
+ perspective
+
+
+
+ 0 0 0.2 0 -0 0
+ 1
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Terrain
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ ConcreteDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ DockDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ MetalGalvanized
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Dock
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Windows_Dark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ RoofCorrugated
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Wall
+
+
+
+
+
+
+
+ model://sydney_regatta/meshes/sydney_regatta.dae
+
+ TreeDiffuse
+
+
+
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta_shore.dae
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -527.49 153.855 0.425844 -0.1365 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -544.833 156.672 0.499025 -0.162625 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+
+
+
+
+ file://antenna/meshes/antenna.dae
+
+
+
+
+ 0 0 0.95 0 -0 0
+
+
+ 0.35
+ 1.9
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+
+
+
+
+ 0.04
+
+ 2.166e-05
+ 0
+ 0
+ 2166
+ 0
+ 2166
+
+ 0 0 0 0 -0 0
+
+
+
+
+ 0.0285
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0.0285
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.02 0 0 0
+
+
+ 0.0285
+
+
+
+
+ -545 60 0.03 0 -0 0
+
+
+ wamv
+ station_keeping
+ /vrx/station_keeping/rms_error
+ /vrx/station_keeping/pose_error
+ /vrx/station_keeping/goal
+ /vrx/task/info
+ /vrx/debug/contact
+ 1
+ -33.722718 150.674031 0.0
+ 10
+ 10
+ 300
+
+
+ wamv_external_pivot_joint
+
+
+ wamv_external_riser
+
+
+
+ 0.2 0.2 2.0
+ 0.5
+
+
+
+ 1
+
+ 0
+ 30
+ 1000 1000
+ 50 50
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+
+ 1
+ 0.1
+ 0.2
+ 0.2
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh.dae
+
+
+
+
+
+ -1
+
+
+ 0 0 -0.05 0 -0 0
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh_below.dae
+
+
+
+
+
+ -1
+
+ 0
+ 0
+ 0
+
+
+
+
+ wamv
+ wamv/base_link
+ .5 .5 .33
+
+ 240
+ 0.0
+ 0
+ 2
+ 10
+ 10
+ /vrx/debug/wind/speed
+ /vrx/debug/wind/direction
+
+
+
+
+ 12
+
+
+ 0
+ 0
+ 1 1 1 1
+ 0.7 0.7 0.7 1
+ 1
+
+ 0 0 -9.8
+ 6e-06 2.3e-05 -4.2e-05
+
+
+ 0.001
+ 1
+ 1000
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -512.865 174.42 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -534.757 180.045 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -520.169 194.084 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -500.395 200.139 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -477.914 196.393 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -459.946 186.774 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -450.82 173.637 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -459.08 154.112 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -476.392 160.515 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -504.951 182.227 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -492.549 183.446 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -475.281 167.759 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -477.534 173.94 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -483.722 179.58 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -526.852 181.058 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -515.013 179.949 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -507.639 193.906 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -485.38 183.383 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -491.205 193.764 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -470.106 180.453 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -471.231 167.929 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -463.516 176.588 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -458.669 167.649 0 0 -0 0
+
+
+ 308 783000000
+ 258 384288392
+ 1727059355 903380846
+ 115356
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 1 1 1
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545 60 0.02334 0 -0 0
+ 1 1 1
+
+ -545 60 0.02334 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 1 1 1
+
+ -540.743 146.687 1.66777 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -539.972 146.474 1.67444 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.727 146.128 1.67569 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.531 147.215 1.6548 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.049 147.325 1.65735 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 1 1 1
+
+ -537.569 146.021 1.6782 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.798 145.808 1.68302 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.553 145.462 1.68831 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.357 146.549 1.66717 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.875 146.659 1.66628 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 1 1 1
+
+ -534.497 145.103 1.71632 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.726 144.89 1.72031 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.481 144.545 1.72896 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.285 145.632 1.70558 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.803 145.741 1.70217 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -506.688 183.619 0.29263 0 -0 0
+ 1 1 1
+
+ -506.688 183.619 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -498.894 186.823 0.29263 0 -0 0
+ 1 1 1
+
+ -498.894 186.823 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -475.281 167.759 0.29263 0 -0 0
+ 1 1 1
+
+ -475.281 167.759 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -477.534 173.94 0.29263 0 -0 0
+ 1 1 1
+
+ -477.534 173.94 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -482.717 181.198 0.29263 0 -0 0
+ 1 1 1
+
+ -482.717 181.198 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -490.472 187.601 0.29263 0 -0 0
+ 1 1 1
+
+ -490.472 187.601 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -520.169 194.084 0.29263 0 -0 0
+ 1 1 1
+
+ -520.169 194.084 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -503.067 202.317 0.29263 0 -0 0
+ 1 1 1
+
+ -503.067 202.317 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -477.914 196.393 0.29263 0 -0 0
+ 1 1 1
+
+ -477.914 196.393 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -465.851 184.412 0.29263 0 -0 0
+ 1 1 1
+
+ -465.851 184.412 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -458.894 171.508 0.29263 0 -0 0
+ 1 1 1
+
+ -458.894 171.508 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -489.571 204.683 0.29263 0 -0 0
+ 1 1 1
+
+ -489.571 204.683 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -514.653 174.368 0.29263 0 -0 0
+ 1 1 1
+
+ -514.653 174.368 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -531.896 181.491 0.29263 0 -0 0
+ 1 1 1
+
+ -531.896 181.491 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -459.08 154.112 0.29263 0 -0 0
+ 1 1 1
+
+ -459.08 154.112 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -476.392 160.515 0.29263 0 -0 0
+ 1 1 1
+
+ -476.392 160.515 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -524.175 181.058 0.142296 0 -0 0
+ 1 1 1
+
+ -524.175 181.058 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -514.027 179.949 0.142296 0 -0 0
+ 1 1 1
+
+ -514.027 179.949 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -507.639 193.906 0.142296 0 -0 0
+ 1 1 1
+
+ -507.639 193.906 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -482.23 186.385 0.142296 0 -0 0
+ 1 1 1
+
+ -482.23 186.385 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -491.205 193.764 0.142296 0 -0 0
+ 1 1 1
+
+ -491.205 193.764 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -470.106 180.453 0.142296 0 -0 0
+ 1 1 1
+
+ -470.106 180.453 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -471.231 169.868 0.142296 0 -0 0
+ 1 1 1
+
+ -471.231 169.868 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -463.516 176.588 0.142296 0 -0 0
+ 1 1 1
+
+ -463.516 176.588 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -462.324 164.073 0.142296 0 -0 0
+ 1 1 1
+
+ -462.324 164.073 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ 0 0 0 0 -0 0
+ 1 1 1
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 1 1 1
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 1 1 1
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 1 1 1
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0.2 0 -0 0
+ 1 1 1
+
+ 0 0 0.2 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.619 167.594 -0.099201 -9.6e-05 -0.00285 1.00001
+ 1 1 1
+
+ -528.588 166.563 0.213428 -0.002083 -0.001947 1.7854
+ 0.00123 0.001916 -0 0 -0 0
+ -0 -0 -5e-06 5.4e-05 7.8e-05 -3e-06
+ -4e-06 -4e-06 -6.9e-05 0 -0 0
+
+
+ -528.528 166.293 -0.296483 -0.002083 -0.001947 1.7854
+ 0.00123 0.001916 -0 0 -0 0
+ 0 0 -5e-06 1e-06 -1e-06 0
+ 0 0 -2e-06 0 -0 0
+
+
+ -526.737 165.375 0.213639 0.001947 -0.002083 0.214619
+ 0.00123 0.001916 -0 0 -0 0
+ -0 -0 -4e-06 -4.9e-05 -7.5e-05 3e-06
+ -4e-06 -4e-06 -5.8e-05 0 -0 0
+
+
+ -527.008 165.316 -0.296309 0.001947 -0.002083 0.214619
+ 0.00123 0.001916 -0 0 -0 0
+ 0 0 -4e-06 1e-06 -1e-06 0
+ 0 0 -2e-06 0 -0 0
+
+
+ -526.285 169.113 0.401657 0.001947 -0.002083 0.214619
+ 0.00123 0.001916 0 0 -0 0
+ -1e-06 -1e-06 2e-06 -4.9e-05 -7.5e-05 3e-06
+ -8e-06 -8e-06 3.4e-05 0 -0 0
+
+
+ -526.556 169.055 -0.108292 0.001947 -0.002083 0.214619
+ 0.00123 0.001916 0 0 -0 0
+ 0 0 2e-06 1e-06 -1e-06 0
+ 0 0 1e-06 0 -0 0
+
+
+ -525.377 168.53 0.40158 -0.002083 -0.001947 1.7854
+ 0.00123 0.001916 0 0 -0 0
+ -1e-06 -1e-06 3e-06 5.4e-05 7.8e-05 -3e-06
+ -8e-06 -8e-06 3.9e-05 0 -0 0
+
+
+ -525.317 168.259 -0.10833 -0.002083 -0.001947 1.7854
+ 0.00123 0.001916 0 0 -0 0
+ 0 0 2e-06 1e-06 -1e-06 0
+ 0 0 1e-06 0 -0 0
+
+
+ -526.582 168.207 1.2023 -0.00038 -0.002826 1.10001
+ 0.00123 0.001915 0 0 -0 -1e-06
+ -1e-06 -2e-06 0 2e-06 -1e-06 1.7e-05
+ -1e-06 -1e-06 0 0 -0 0
+
+
+ -526.591 168.189 1.31012 -0.000547 -0.802826 1.1004
+ 0.00123 0.001915 0 0 -0 -1e-06
+ -1e-06 -2e-06 0 2.5e-05 5e-05 7.1e-05
+ -1e-06 -1e-06 0 0 -0 0
+
+
+ -526.619 167.594 -0.099201 -9.6e-05 -0.00285 1.00001
+ 0.00123 0.001916 -0 0 -0 0
+ 0 0 -0 -0.362974 -0.259059 -0.007291
+ 2.5e-05 2.7e-05 -7.7e-05 0 -0 0
+
+
+ -526.635 167.884 1.40146 -9.6e-05 -0.00285 1.00001
+ 0.00123 0.001915 0 0 -0 0
+ -2e-06 -2e-06 -0 1e-06 -2e-06 -1e-06
+ -0 -0 -0 0 -0 0
+
+
+ -526.635 167.884 1.40146 -9.6e-05 -0.00285 1.00001
+ 0.00123 0.001915 0 0 -0 0
+ -2e-06 -2e-06 -0 1e-06 -1e-06 -1e-06
+ -2e-06 -2e-06 -0 0 -0 0
+
+
+
+ 0 0 10 0 -0 0
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -490.472 187.601 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -489.571 204.683 0 0 -0 0
+
+
+
diff --git a/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/straight_test.world b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/straight_test.world
new file mode 100644
index 000000000..8aa1802df
--- /dev/null
+++ b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/straight_test.world
@@ -0,0 +1,3882 @@
+
+
+
+ EARTH_WGS84
+ ENU
+ -33.7242
+ 150.68
+ 0
+ 0
+
+
+ 1
+ 0 0 10 0 -0 0
+ 0.8 0.8 0.8 1
+ 0.2 0.2 0.2 1
+
+ 1000
+ 0.9
+ 0.01
+ 0.001
+
+ -0.5 0.1 -0.9
+
+ 0
+ 0
+ 0
+
+
+
+
+ -515.743 216.73 125.391 3.14159 1.57079 3.14159
+ orbit
+ perspective
+
+
+
+ 0 0 0.2 0 -0 0
+ 1
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Terrain
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ ConcreteDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ DockDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ MetalGalvanized
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Dock
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Windows_Dark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ RoofCorrugated
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Wall
+
+
+
+
+
+
+
+ model://sydney_regatta/meshes/sydney_regatta.dae
+
+ TreeDiffuse
+
+
+
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta_shore.dae
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -527.49 153.855 0.425844 -0.1365 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -544.833 156.672 0.499025 -0.162625 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+
+
+
+
+ file://antenna/meshes/antenna.dae
+
+
+
+
+ 0 0 0.95 0 -0 0
+
+
+ 0.35
+ 1.9
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+
+
+
+
+ 0.04
+
+ 2.166e-05
+ 0
+ 0
+ 2166
+ 0
+ 2166
+
+ 0 0 0 0 -0 0
+
+
+
+
+ 0.0285
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0.0285
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.02 0 0 0
+
+
+ 0.0285
+
+
+
+
+ -545 60 0.03 0 -0 0
+
+
+ wamv
+ station_keeping
+ /vrx/station_keeping/rms_error
+ /vrx/station_keeping/pose_error
+ /vrx/station_keeping/goal
+ /vrx/task/info
+ /vrx/debug/contact
+ 1
+ -33.722718 150.674031 0.0
+ 10
+ 10
+ 300
+
+
+ wamv_external_pivot_joint
+
+
+ wamv_external_riser
+
+
+
+ 0.2 0.2 2.0
+ 0.5
+
+
+
+ 1
+
+ 0
+ 30
+ 1000 1000
+ 50 50
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+
+ 1
+ 0.1
+ 0.2
+ 0.2
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh.dae
+
+
+
+
+
+ -1
+
+
+ 0 0 -0.05 0 -0 0
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh_below.dae
+
+
+
+
+
+ -1
+
+ 0
+ 0
+ 0
+
+
+
+
+ wamv
+ wamv/base_link
+ .5 .5 .33
+
+ 240
+ 0.0
+ 0
+ 2
+ 10
+ 10
+ /vrx/debug/wind/speed
+ /vrx/debug/wind/direction
+
+
+
+
+ 12
+
+
+ 0
+ 0
+ 1 1 1 1
+ 0.7 0.7 0.7 1
+ 1
+
+ 0 0 -9.8
+ 6e-06 2.3e-05 -4.2e-05
+
+
+ 0.001
+ 1
+ 1000
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -515.494 173.654 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -530.437 180.446 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -526.2 192.348 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -521.935 205.433 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -517.476 217.879 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -513.055 229.807 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -509.095 242.246 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -505.136 254.091 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -511.002 188.091 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -507.24 202.361 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -503.677 214.85 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -499.182 227.901 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -495.554 240.043 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -491.801 253.623 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -502.401 267.102 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -489.005 268.208 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -493.981 261.513 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -502.082 250.025 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -498.784 239.074 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -503.3 226.636 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -513.05 221.797 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -511.832 210.684 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -508.39 203.981 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -518.284 201.096 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -515.631 186.991 0 0 -0 0
+
+
+ 193 46000000
+ 414 481901154
+ 1727053102 63032403
+ 193046
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 1 1 1
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545 60 0.02334 0 -0 0
+ 1 1 1
+
+ -545 60 0.02334 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 1 1 1
+
+ -540.743 146.687 1.66777 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -539.972 146.474 1.67444 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.727 146.128 1.67569 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.531 147.215 1.6548 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.049 147.325 1.65735 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 1 1 1
+
+ -537.569 146.021 1.6782 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.798 145.808 1.68302 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.553 145.462 1.68831 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.357 146.549 1.66717 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.875 146.659 1.66628 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 1 1 1
+
+ -534.497 145.103 1.71632 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.726 144.89 1.72031 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.481 144.545 1.72896 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.285 145.632 1.70558 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.803 145.741 1.70217 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -511.002 188.091 0.29263 0 -0 0
+ 1 1 1
+
+ -511.002 188.091 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -507.24 202.361 0.29263 0 -0 0
+ 1 1 1
+
+ -507.24 202.361 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -503.677 214.85 0.29263 0 -0 0
+ 1 1 1
+
+ -503.677 214.85 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -499.182 227.901 0.29263 0 -0 0
+ 1 1 1
+
+ -499.182 227.901 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -495.554 240.043 0.29263 0 -0 0
+ 1 1 1
+
+ -495.554 240.043 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -491.801 253.623 0.29263 0 -0 0
+ 1 1 1
+
+ -491.801 253.623 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -526.2 192.348 0.29263 0 -0 0
+ 1 1 1
+
+ -526.2 192.348 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -521.935 205.433 0.29263 0 -0 0
+ 1 1 1
+
+ -521.935 205.433 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -517.476 217.879 0.29263 0 -0 0
+ 1 1 1
+
+ -517.476 217.879 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -513.055 229.807 0.29263 0 -0 0
+ 1 1 1
+
+ -513.055 229.807 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -509.095 242.246 0.29263 0 -0 0
+ 1 1 1
+
+ -509.095 242.246 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -505.136 254.091 0.29263 0 -0 0
+ 1 1 1
+
+ -505.136 254.091 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -514.773 175.255 0.29263 0 -0 0
+ 1 1 1
+
+ -514.773 175.255 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -530.437 180.446 0.29263 0 -0 0
+ 1 1 1
+
+ -530.437 180.446 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -502.401 267.102 0.29263 0 -0 0
+ 1 1 1
+
+ -502.401 267.102 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -489.088 266.251 0.29263 0 -0 0
+ 1 1 1
+
+ -489.088 266.251 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -493.981 261.513 0.142296 0 -0 0
+ 1 1 1
+
+ -493.981 261.513 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -502.082 250.025 0.142296 0 -0 0
+ 1 1 1
+
+ -502.082 250.025 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -498.784 239.074 0.142296 0 -0 0
+ 1 1 1
+
+ -498.784 239.074 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -503.3 226.636 0.142296 0 -0 0
+ 1 1 1
+
+ -503.3 226.636 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 1e-06 0 -0 0
+
+
+
+ -513.05 221.797 0.142296 0 -0 0
+ 1 1 1
+
+ -513.05 221.797 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 2e-06 0 -0 0
+
+
+
+ -511.832 210.684 0.142296 0 -0 0
+ 1 1 1
+
+ -511.832 210.684 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 1e-06 0 -0 0
+ 0 0 3e-06 0 -0 0
+
+
+
+ -508.39 203.981 0.142296 0 -0 0
+ 1 1 1
+
+ -508.39 203.981 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -4e-06 0 -0 0
+ 0 0 -1.3e-05 0 -0 0
+
+
+
+ -518.284 201.096 0.142296 0 -0 0
+ 1 1 1
+
+ -518.284 201.096 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -8e-06 0 -0 0
+ 0 0 -2.7e-05 0 -0 0
+
+
+
+ -515.631 186.991 0.142296 0 -0 0
+ 1 1 1
+
+ -515.631 186.991 0.142296 0 -0 0
+ 0 0 2e-06 0 -0 0
+ 0 0 -2.6e-05 0 -0 0
+ 0 0 -9.1e-05 0 -0 0
+
+
+
+ 0 0 0 0 -0 0
+ 1 1 1
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 1 1 1
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 1 1 1
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 1 1 1
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0.2 0 -0 0
+ 1 1 1
+
+ 0 0 0.2 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0 0 -0 0
+ 1 1 1
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 10 0 -0 0
+
+
+
+
diff --git a/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/u_shaped_test.world b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/u_shaped_test.world
new file mode 100644
index 000000000..dc0ae73bb
--- /dev/null
+++ b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/u_shaped_test.world
@@ -0,0 +1,3882 @@
+
+
+
+ EARTH_WGS84
+ ENU
+ -33.7242
+ 150.68
+ 0
+ 0
+
+
+ 1
+ 0 0 10 0 -0 0
+ 0.8 0.8 0.8 1
+ 0.2 0.2 0.2 1
+
+ 1000
+ 0.9
+ 0.01
+ 0.001
+
+ -0.5 0.1 -0.9
+
+ 0
+ 0
+ 0
+
+
+
+
+ -447.966 188.768 14.1549 -0 0.248627 2.9125
+ orbit
+ perspective
+
+
+
+ 0 0 0.2 0 -0 0
+ 1
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Terrain
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ ConcreteDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ DockDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ MetalGalvanized
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Dock
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Windows_Dark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ RoofCorrugated
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Wall
+
+
+
+
+
+
+
+ model://sydney_regatta/meshes/sydney_regatta.dae
+
+ TreeDiffuse
+
+
+
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta_shore.dae
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -527.49 153.855 0.425844 -0.1365 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -544.833 156.672 0.499025 -0.162625 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+
+
+
+
+ file://antenna/meshes/antenna.dae
+
+
+
+
+ 0 0 0.95 0 -0 0
+
+
+ 0.35
+ 1.9
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+
+
+
+
+ 0.04
+
+ 2.166e-05
+ 0
+ 0
+ 2166
+ 0
+ 2166
+
+ 0 0 0 0 -0 0
+
+
+
+
+ 0.0285
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0.0285
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.02 0 0 0
+
+
+ 0.0285
+
+
+
+
+ -545 60 0.03 0 -0 0
+
+
+ wamv
+ station_keeping
+ /vrx/station_keeping/rms_error
+ /vrx/station_keeping/pose_error
+ /vrx/station_keeping/goal
+ /vrx/task/info
+ /vrx/debug/contact
+ 1
+ -33.722718 150.674031 0.0
+ 10
+ 10
+ 300
+
+
+ wamv_external_pivot_joint
+
+
+ wamv_external_riser
+
+
+
+ 0.2 0.2 2.0
+ 0.5
+
+
+
+ 1
+
+ 0
+ 30
+ 1000 1000
+ 50 50
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+
+ 1
+ 0.1
+ 0.2
+ 0.2
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh.dae
+
+
+
+
+
+ -1
+
+
+ 0 0 -0.05 0 -0 0
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh_below.dae
+
+
+
+
+
+ -1
+
+ 0
+ 0
+ 0
+
+
+
+
+ wamv
+ wamv/base_link
+ .5 .5 .33
+
+ 240
+ 0.0
+ 0
+ 2
+ 10
+ 10
+ /vrx/debug/wind/speed
+ /vrx/debug/wind/direction
+
+
+
+
+ 12
+
+
+ 0
+ 0
+ 1 1 1 1
+ 0.7 0.7 0.7 1
+ 1
+
+ 0 0 -9.8
+ 6e-06 2.3e-05 -4.2e-05
+
+
+ 0.001
+ 1
+ 1000
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -529.678 178.924 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -513.004 172.458 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -522.762 189.762 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -506.86 197.468 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -506.571 181.788 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -495.729 186.572 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -481.521 190.74 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -494.07 202.298 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -472.903 200.729 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -498.09 212.53 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -476.901 210.904 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -487.053 220.799 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -504.917 218.288 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -504.906 219.489 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -509.403 226.982 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -492.686 228.986 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -514.941 179.078 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -512.38 190.146 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -494.552 191.674 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -506.727 194.474 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -479.714 197.842 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -488.863 205.696 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -490.924 212.746 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -493.562 224.307 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -500.514 219.362 0 0 -0 0
+
+
+ 169 49000000
+ 368 277934450
+ 1726449908 926485616
+ 169049
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 1 1 1
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545 60 0.02334 0 -0 0
+ 1 1 1
+
+ -545 60 0.02334 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 1 1 1
+
+ -540.743 146.687 1.66777 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -539.972 146.474 1.67444 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.727 146.128 1.67569 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.531 147.215 1.6548 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.049 147.325 1.65735 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 1 1 1
+
+ -537.569 146.021 1.6782 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.798 145.808 1.68302 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.553 145.462 1.68831 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.357 146.549 1.66717 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.875 146.659 1.66628 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 1 1 1
+
+ -534.497 145.103 1.71632 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.726 144.89 1.72031 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.481 144.545 1.72896 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.285 145.632 1.70558 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.803 145.741 1.70217 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -506.571 181.788 0.29263 0 -0 0
+ 1 1 1
+
+ -506.571 181.788 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -495.729 186.572 0.29263 0 -0 0
+ 1 1 1
+
+ -495.729 186.572 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -484.228 192.279 0.29263 0 -0 0
+ 1 1 1
+
+ -484.228 192.279 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -472.903 200.729 0.29263 0 -0 0
+ 1 1 1
+
+ -472.903 200.729 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -476.901 210.904 0.29263 0 -0 0
+ 1 1 1
+
+ -476.901 210.904 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -487.053 220.799 0.29263 0 -0 0
+ 1 1 1
+
+ -487.053 220.799 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -522.762 187.766 0.29263 0 -0 0
+ 1 1 1
+
+ -522.762 187.766 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -511.494 194.843 0.29263 0 -0 0
+ 1 1 1
+
+ -511.494 194.843 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -495.942 199.688 0.29263 0 -0 0
+ 1 1 1
+
+ -495.942 199.688 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -494.265 207.437 0.29263 0 -0 0
+ 1 1 1
+
+ -494.265 207.437 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -497.194 214.361 0.29263 0 -0 0
+ 1 1 1
+
+ -497.194 214.361 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -504.906 219.489 0.29263 0 -0 0
+ 1 1 1
+
+ -504.906 219.489 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -529.678 178.924 0.29263 0 -0 0
+ 1 1 1
+
+ -529.678 178.924 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -513.004 172.458 0.29263 0 -0 0
+ 1 1 1
+
+ -513.004 172.458 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -509.403 226.982 0.29263 0 -0 0
+ 1 1 1
+
+ -509.403 226.982 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -492.686 228.986 0.29263 0 -0 0
+ 1 1 1
+
+ -492.686 228.986 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -514.941 179.078 0.142296 0 -0 0
+ 1 1 1
+
+ -514.941 179.078 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -512.38 190.146 0.142296 0 -0 0
+ 1 1 1
+
+ -512.38 190.146 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -494.552 191.674 0.142296 0 -0 0
+ 1 1 1
+
+ -494.552 191.674 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -506.727 194.474 0.142296 0 -0 0
+ 1 1 1
+
+ -506.727 194.474 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -479.714 197.842 0.142296 0 -0 0
+ 1 1 1
+
+ -479.714 197.842 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -488.863 205.696 0.142296 0 -0 0
+ 1 1 1
+
+ -488.863 205.696 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -490.924 212.746 0.142296 0 -0 0
+ 1 1 1
+
+ -490.924 212.746 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -493.562 224.307 0.142296 0 -0 0
+ 1 1 1
+
+ -493.562 224.307 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -500.514 219.362 0.142296 0 -0 0
+ 1 1 1
+
+ -500.514 219.362 0.142296 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0.968469 -0.657935 0 0 -0 0
+ 1 1 1
+
+ 0.968469 -0.657935 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 1 1 1
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 1 1 1
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 1 1 1
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0.2 0 -0 0
+ 1 1 1
+
+ 0 0 0.2 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0 0 -0 0
+ 1 1 1
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 10 0 -0 0
+
+
+
+
diff --git a/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/zig_zag_test.world b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/zig_zag_test.world
new file mode 100644
index 000000000..497d53c9e
--- /dev/null
+++ b/NaviGator/simulation/navigator_gazebo/worlds/pathfinding/zig_zag_test.world
@@ -0,0 +1,3595 @@
+
+
+
+ EARTH_WGS84
+ ENU
+ -33.7242
+ 150.68
+ 0
+ 0
+
+
+ 1
+ 0 0 10 0 -0 0
+ 0.8 0.8 0.8 1
+ 0.2 0.2 0.2 1
+
+ 1000
+ 0.9
+ 0.01
+ 0.001
+
+ -0.5 0.1 -0.9
+
+ 0
+ 0
+ 0
+
+
+
+
+ -459.05 191.475 120.479 0 1.22863 2.7725
+ orbit
+ perspective
+
+
+
+ 0 0 0.2 0 -0 0
+ 1
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Terrain
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ ConcreteDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ DockDark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ MetalGalvanized
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Dock
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Windows_Dark
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ RoofCorrugated
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta.dae
+
+ Wall
+
+
+
+
+
+
+
+ model://sydney_regatta/meshes/sydney_regatta.dae
+
+ TreeDiffuse
+
+
+
+
+
+
+
+
+
+
+ file://sydney_regatta/meshes/sydney_regatta_shore.dae
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -527.49 153.855 0.425844 -0.1365 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+ -544.833 156.672 0.499025 -0.162625 0 0
+
+
+
+
+ file://post/meshes/post.dae
+
+
+
+
+ 0 0 0.5 0 -0 0
+
+
+ 0.3
+ 1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+
+ 1
+
+
+
+
+ file://antenna/meshes/antenna.dae
+
+
+
+
+ 0 0 0.95 0 -0 0
+
+
+ 0.35
+ 1.9
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+
+
+ 1
+
+ 0 0 0 0 -0 0
+
+ 1
+
+
+
+
+ model://tent/mesh/tent.dae
+
+
+
+
+ 0 0 1.5 0 -0 0
+
+
+ 3 3 3
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.5 0.9 0 0 -0 0
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 1 -0.5 0 0 -0 1.57
+
+ 1
+
+
+
+
+ model://foldable_table/mesh/foldable_table.dae
+
+
+
+
+ 0 0 0.35 0 -0 0
+
+
+ 1.82 0.74 0.67
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 0 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ 0.2 -0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+
+ -0.6 0.8 0 0 -0 1.57
+
+ 1
+
+
+
+
+ 0.1 0.1 0.1
+ model://foldable_chair/mesh/foldable_chair.dae
+
+
+
+
+ 0 0.05 0.4 0 -0 0
+
+
+ 0.5 0.5 0.8
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 0 -0 0
+ 0
+ 0
+ 0
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+
+
+
+
+ 0.04
+
+ 2.166e-05
+ 0
+ 0
+ 2166
+ 0
+ 2166
+
+ 0 0 0 0 -0 0
+
+
+
+
+ 0.0285
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0.0285
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.02 0 0 0
+
+
+ 0.0285
+
+
+
+
+ -545 60 0.03 0 -0 0
+
+
+ wamv
+ station_keeping
+ /vrx/station_keeping/rms_error
+ /vrx/station_keeping/pose_error
+ /vrx/station_keeping/goal
+ /vrx/task/info
+ /vrx/debug/contact
+ 1
+ -33.722718 150.674031 0.0
+ 10
+ 10
+ 300
+
+
+ wamv_external_pivot_joint
+
+
+ wamv_external_riser
+
+
+
+ 0.2 0.2 2.0
+ 0.5
+
+
+
+ 1
+
+ 0
+ 30
+ 1000 1000
+ 50 50
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+
+ 1
+ 0.1
+ 0.2
+ 0.2
+
+ PMS
+ 5.0
+ 3
+ 2.5
+ 0.0
+ 1.0 0.0
+ 0.4
+ 2.0
+ 0.0
+ 0.0
+
+
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh.dae
+
+
+
+
+
+ -1
+
+
+ 0 0 -0.05 0 -0 0
+
+
+ 2.5 2.5 1
+ model://ocean_waves/meshes/mesh_below.dae
+
+
+
+
+
+ -1
+
+ 0
+ 0
+ 0
+
+
+
+
+ wamv
+ wamv/base_link
+ .5 .5 .33
+
+ 240
+ 0.0
+ 0
+ 2
+ 10
+ 10
+ /vrx/debug/wind/speed
+ /vrx/debug/wind/direction
+
+
+
+
+ 12
+
+
+ 0
+ 0
+ 1 1 1 1
+ 0.7 0.7 0.7 1
+ 1
+
+ 0 0 -9.8
+ 6e-06 2.3e-05 -4.2e-05
+
+
+ 0.001
+ 1
+ 1000
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -529.678 178.924 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -513.004 172.458 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -522.762 189.762 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -506.571 181.788 0 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -514.941 179.078 0 0 -0 0
+
+
+ 175 887000000
+ 7 69807986
+ 1726974143 328291009
+ 6838
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 1 1 1
+
+ -531.064 147.669 1.59471 -0.068142 0 -0.1
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -545 60 0.02334 0 -0 0
+ 1 1 1
+
+ -545 60 0.02334 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 1 1 1
+
+ -540.743 146.687 1.66777 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -539.972 146.474 1.67444 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.727 146.128 1.67569 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -541.531 147.215 1.6548 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.049 147.325 1.65735 0.018234 0.008353 2.87188
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -540.796 146.494 1.67142 -0.00834 0.01824 1.30173
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 1 1 1
+
+ -537.569 146.021 1.6782 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.798 145.808 1.68302 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.553 145.462 1.68831 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -538.357 146.549 1.66717 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -536.875 146.659 1.66628 0.018663 0.006044 2.87168
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -537.623 145.828 1.68193 -0.00603 0.018667 1.30157
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 1 1 1
+
+ -534.497 145.103 1.71632 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.726 144.89 1.72031 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.481 144.545 1.72896 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -535.285 145.632 1.70558 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -533.803 145.741 1.70217 0.020794 0.005009 2.8716
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+ -534.551 144.91 1.72047 -0.004994 0.020798 1.30149
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -506.571 181.788 0.29263 0 -0 0
+ 1 1 1
+
+ -506.571 181.788 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -510.64 194.915 0.29263 0 -0 0
+ 1 1 1
+
+ -510.64 194.915 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -501.638 202.327 0.29263 0 -0 0
+ 1 1 1
+
+ -501.638 202.327 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -504.421 214.898 0.29263 0 -0 0
+ 1 1 1
+
+ -504.421 214.898 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -495.667 224.021 0.29263 0 -0 0
+ 1 1 1
+
+ -495.667 224.021 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -522.762 187.766 0.29263 0 -0 0
+ 1 1 1
+
+ -522.762 187.766 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -526.019 198.035 0.29263 0 -0 0
+ 1 1 1
+
+ -526.019 198.035 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -517.634 209.013 0.29263 0 -0 0
+ 1 1 1
+
+ -517.634 209.013 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -522.54 219.714 0.29263 0 -0 0
+ 1 1 1
+
+ -522.54 219.714 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -511.689 229.065 0.29263 0 -0 0
+ 1 1 1
+
+ -511.689 229.065 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -529.678 178.924 0.29263 0 -0 0
+ 1 1 1
+
+ -529.678 178.924 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -513.004 172.458 0.29263 0 -0 0
+ 1 1 1
+
+ -513.004 172.458 0.29263 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 -0 0 -0 0
+
+
+
+ -497.832 237.001 0.29263 0 -0 0
+ 1 1 1
+
+ -497.832 237.001 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -513.555 240.958 0.29263 0 -0 0
+ 1 1 1
+
+ -513.555 240.958 0.29263 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -2.8e-05 0 -0 0
+
+
+
+ -514.941 179.078 0.142296 0 -0 0
+ 1 1 1
+
+ -514.941 179.078 0.142296 0 -0 0
+ 0 0 -0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -511.014 187.529 0.142296 0 -0 0
+ 1 1 1
+
+ -511.014 187.529 0.142296 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -6e-06 0 -0 0
+ 0 0 -2.3e-05 0 -0 0
+
+
+
+ -514.25 200.165 0.142296 0 -0 0
+ 1 1 1
+
+ -514.25 200.165 0.142296 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -6e-06 0 -0 0
+ 0 0 -2.3e-05 0 -0 0
+
+
+
+ -508.025 209.686 0.142296 0 -0 0
+ 1 1 1
+
+ -508.025 209.686 0.142296 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -6e-06 0 -0 0
+ 0 0 -2.3e-05 0 -0 0
+
+
+
+ -513.838 220.548 0.142296 0 -0 0
+ 1 1 1
+
+ -513.838 220.548 0.142296 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -6e-06 0 -0 0
+ 0 0 -2.3e-05 0 -0 0
+
+
+
+ -503.573 221.697 0.142296 0 -0 0
+ 1 1 1
+
+ -503.573 221.697 0.142296 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -6e-06 0 -0 0
+ 0 0 -2.3e-05 0 -0 0
+
+
+
+ -507 231 0.142296 0 -0 0
+ 1 1 1
+
+ -507 231 0.142296 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -6e-06 0 -0 0
+ 0 0 -2.3e-05 0 -0 0
+
+
+
+ -501 227 0.142296 0 -0 0
+ 1 1 1
+
+ -501 227 0.142296 0 -0 0
+ 0 0 -1e-06 0 -0 0
+ 0 0 -6e-06 0 -0 0
+ 0 0 -2.3e-05 0 -0 0
+
+
+
+ 0.968469 -0.657935 0 0 -0 0
+ 1 1 1
+
+ 0.968469 -0.657935 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 1 1 1
+
+ -535.917 154.363 0.675884 -0.17182 0.030464 -0.005286
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 1 1 1
+
+ -527.49 153.855 0.425844 -0.1365 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 1 1 1
+
+ -544.833 156.672 0.499025 -0.162625 0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 0 0 0.2 0 -0 0
+ 1 1 1
+
+ 0 0 0.2 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+ 0 0 0 0 -0 0
+
+
+
+ 2.88378 0.021373 -0.099173 -0.000167 -0.001344 0.019141
+ 1 1 1
+
+ 0.932249 1.08427 0.216286 -0.001068 -0.000832 0.804539
+ 0.129789 -0.000465 0.019482 0.002087 0.008682 0.000112
+ -0.054329 -0.004284 -0.227625 0.019119 -0.129226 -0.000699
+ -0.814929 -0.064259 -3.41438 0 -0 0
+
+
+ 0.740049 0.883782 -0.293316 0.093482 -0.000832 0.804539
+ 0.125387 0.000577 0.020732 0.002087 0.008682 0.000112
+ 0.01079 0.006412 -0.256349 0.020666 -0.127591 -0.004148
+ 0.005395 0.003206 -0.128174 0 -0 0
+
+
+ 0.974356 -1.11533 0.216654 0.000832 -0.001068 -0.766252
+ 0.130228 -0.000458 0.014526 0.002087 0.008682 0.000265
+ -0.054335 -0.00428 -0.268261 0.02221 -0.1296 -0.001417
+ -0.815024 -0.064197 -4.02392 0 -0 0
+
+
+ 0.774627 -0.922516 -0.293014 -0.005573 -0.001068 -0.766252
+ 0.125752 0.000553 0.016662 0.002087 0.008682 0.000265
+ 0.011022 0.006566 -0.289719 0.020923 -0.127837 -0.000724
+ 0.005511 0.003283 -0.144859 0 -0 0
+
+
+ 4.3325 0.589288 0.399448 0.000832 -0.001068 -0.766257
+ 0.131477 -0.000173 -0.011072 0.002087 0.008682 0.000207
+ -0.077998 -0.007921 0.196697 0.022249 -0.129605 -0.000741
+ -1.16997 -0.118821 2.95045 0 -0 0
+
+
+ 4.13277 0.782102 -0.110219 0.001584 -0.001068 -0.766257
+ 0.127012 0.000849 -0.008936 0.002087 0.008682 0.000207
+ -0.012771 0.002789 0.175239 0.020919 -0.127841 -0.000272
+ -0.006386 0.001395 0.08762 0 -0 0
+
+
+ 4.35317 -0.490514 0.399449 -0.001068 -0.000832 0.804541
+ 0.131691 -0.000169 -0.013505 0.002087 0.008682 0.000181
+ -0.077978 -0.007916 0.176748 0.019089 -0.129223 -0.000647
+ -1.16967 -0.118734 2.65123 0 -0 0
+
+
+ 4.16097 -0.691001 -0.110153 0.011225 -0.000832 0.804541
+ 0.127303 0.000859 -0.012255 0.002087 0.008682 0.000181
+ -0.012849 0.002771 0.148025 0.020916 -0.127837 -0.000649
+ -0.006425 0.001385 0.074012 0 -0 0
+
+
+ 3.41618 0.331837 1.2015 -0.0003 -0.00132 0.119141
+ 0.138491 -0.002029 -0.003654 0.002087 0.008682 0.000198
+ -0.186847 -0.02577 0.071501 0.026718 -0.128634 -0.001275
+ -0.093423 -0.012885 0.03575 0 -0 0
+
+
+ 3.39578 0.329428 1.30935 -0.000432 -0.80132 0.119451
+ 0.139428 -0.002258 -0.003482 0.002087 0.008682 0.000198
+ -0.194246 -0.02698 0.071434 -0.043101 -0.133353 -0.048707
+ -0.097123 -0.01349 0.035717 0 -0 0
+
+
+ 2.88378 0.021373 -0.099173 -0.000167 -0.001344 0.019141
+ 0.12726 0.00058 0.00032 0.002087 0.008682 0.000198
+ -0.017479 0.001882 0.001273 0.008537 -0.128607 -0.000182
+ -3.19532 0.344118 0.232796 0 -0 0
+
+
+ 3.11846 0.196147 1.40112 -0.000167 -0.001344 0.019141
+ 0.140251 -0.002504 -0.001352 0.002087 0.008682 0.000198
+ -0.20595 -0.028941 0.033185 0.020672 -0.12778 8.4e-05
+ -0.020595 -0.002894 0.003318 0 -0 0
+
+
+ 3.11846 0.196147 1.40112 -0.000167 -0.001344 0.019141
+ 0.140251 -0.002504 -0.001352 0.002087 0.008682 0.000198
+ -0.20595 -0.028941 0.033185 0.020919 -0.127841 5.8e-05
+ -0.20595 -0.028941 0.033185 0 -0 0
+
+
+
+ 0 0 10 0 -0 0
+
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -526.019 198.035 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -510.64 194.915 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -517.634 209.013 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -501.638 202.327 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -522.54 219.714 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -504.421 214.898 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -511.689 229.065 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -495.667 224.021 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -513.555 240.958 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 20
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+ 0 -0.02 0.02 0 -0 0
+
+
+ 0.15
+ 1.15
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 -0.3 0 -0 0
+
+
+ 0.325
+ 0.1
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ 0 0 0 1.57079 -0 0
+
+
+ model://mb_marker_buoy_red/meshes/mb_marker_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 -0.12 0 0 0
+
+
+ 0.325
+
+
+
+
+ -497.832 237.001 0.29263 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -511.014 187.529 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -514.25 200.165 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -508.025 209.686 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -513.838 220.548 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -503.573 221.697 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -507 231 0.142296 0 -0 0
+
+
+
+
+ 0 0 -2 0 -0 0
+ 3.5
+
+ 1
+ 0
+ 0
+ 1
+ 0
+ 0.1
+
+
+
+
+
+ 0.25
+
+
+ 10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ model://mb_round_buoy_orange/meshes/mb_round_buoy.dae
+
+
+
+
+
+
+ 0
+ 0
+ 0
+
+
+ ocean_waves
+ 1000
+ 0.0
+ 25.0
+ 2.0
+
+ link
+ 0 0 0.02 0 0 0
+
+
+ 0.235
+
+
+
+
+ -501 227 0.142296 0 -0 0
+
+
+