diff --git a/models/iris_with_standoffs/model.sdf b/models/iris_with_standoffs/model.sdf
index ad4980cc..94b2b916 100755
--- a/models/iris_with_standoffs/model.sdf
+++ b/models/iris_with_standoffs/model.sdf
@@ -20,11 +20,10 @@
- 0 0 -0.08 0 0 0
-
- 0.47 0.47 0.23
-
+
+ model://iris_with_standoffs/meshes/iris.dae
+
@@ -41,6 +40,43 @@
+
+ 0.123 0.22 -0.11 0 0 0
+
+
+ 0.005
+ 0.17
+
+
+
+
+ 0.123 -0.22 -0.11 0 0 0
+
+
+ 0.005
+ 0.17
+
+
+
+
+ -0.140 0.21 -0.11 0 0 0
+
+
+ 0.005
+ 0.17
+
+
+
+
+ -0.140 -0.21 -0.11 0 0 0
+
+
+ 0.005
+ 0.17
+
+
+
+
diff --git a/models/tether/model.config b/models/tether/model.config
new file mode 100644
index 00000000..78d2e172
--- /dev/null
+++ b/models/tether/model.config
@@ -0,0 +1,13 @@
+
+
+ tether
+ 1.0.0
+ model.sdf
+
+ Nuno Marques
+ n.marques21@hotmail.com
+
+
+ This model approximates a tether cord.
+
+
diff --git a/models/tether/model.sdf b/models/tether/model.sdf
new file mode 100644
index 00000000..1d382d1c
--- /dev/null
+++ b/models/tether/model.sdf
@@ -0,0 +1,1464 @@
+
+
+
+
+
+ true
+ -0.1 0 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.1 0 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.3 0 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.5 0 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.7 0 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.9 0 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 1.1 0 0 0 0 -.785
+
+ 0.00455
+ 0.0875 0 0 0 0 0
+
+ 2.0475E-08
+ 0
+ 0
+ 1.16222E-05
+ 0
+ 1.16222E-05
+
+
+
+ 0.0875 0 0 0 1.570790 0
+
+
+ 0.175
+ 0.003
+
+
+
+
+ 0.0875 0 0 0 1.570790 0
+
+
+ 0.175
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 1.227 -.127 0 0 0 -2.3415
+
+ 0.00455
+ 0.0875 0 0 0 0 0
+
+ 2.0475E-08
+ 0
+ 0
+ 1.16222E-05
+ 0
+ 1.16222E-05
+
+
+
+ 0.0875 0 0 0 1.570790 0
+
+
+ 0.175
+ 0.003
+
+
+
+
+ 0.0875 0 0 0 1.570790 0
+
+
+ 0.175
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 1.1 -.254 0 0 0 -3.1415
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.9 -.254 0 0 0 -3.1415
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.7 -.254 0 0 0 -3.1415
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.5 -.254 0 0 0 -3.1415
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.3 -.254 0 0 0 -3.1415
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.1 -.254 0 0 0 -2.356
+
+ 0.00455
+ 0.0875 0 0 0 0 0
+
+ 2.0475E-08
+ 0
+ 0
+ 1.16222E-05
+ 0
+ 1.16222E-05
+
+
+
+ 0.0875 0 0 0 1.570790 0
+
+
+ 0.175
+ 0.003
+
+
+
+
+ 0.0875 0 0 0 1.570790 0
+
+
+ 0.175
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ -0.027 -.381 0 0 0 -.785
+
+ 0.00455
+ 0.0875 0 0 0 0 0
+
+ 2.0475E-08
+ 0
+ 0
+ 1.16222E-05
+ 0
+ 1.16222E-05
+
+
+
+ 0.0875 0 0 0 1.570790 0
+
+
+ 0.175
+ 0.003
+
+
+
+
+ 0.0875 0 0 0 1.570790 0
+
+
+ 0.175
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.1 -.508 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.3 -.508 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.5 -.508 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.7 -.508 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+ 1 1 1
+ 1 1 1
+ 0.01 0.01 0.01 1.0
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ true
+ 0.9 -.508 0 0 0 0
+
+ 0.0052
+ 0.1 0 0 0 0 0
+
+ 2.34E-08
+ 0
+ 0
+ 1.7345E-05
+ 0
+ 1.7345E-05
+
+
+
+ 0.1 0 0 0 1.570790 0
+
+
+ 0.2
+ 0.003
+
+
+
+
+
+
+ 0.009
+
+
+
+ 1 0 0
+ 1 0 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ link_01
+ link_00
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_02
+ link_01
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_03
+ link_02
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_04
+ link_03
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_05
+ link_04
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_06
+ link_05
+
+ 0 0 1
+
+ -0.72
+ 2.35
+
+
+ 0.004
+
+
+
+ 1 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_07
+ link_06
+
+ 0 0 1
+
+ -0.0
+ 3.00
+
+
+ 0.004
+
+
+
+ -1 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_08
+ link_07
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -0.72
+ 2.35
+
+
+ 0.004
+
+
+
+
+ link_09
+ link_08
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_10
+ link_09
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_11
+ link_10
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_12
+ link_11
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_13
+ link_12
+
+ 0 0 1
+
+ -2.35
+ 0.72
+
+
+ 0.004
+
+
+
+ -1 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_14
+ link_13
+
+ 0 0 1
+
+ -3.00
+ 0.0
+
+
+ 0.004
+
+
+
+ 1 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_15
+ link_14
+
+ 0 0 1
+
+ -2.35
+ 0.72
+
+
+ 0.004
+
+
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_16
+ link_15
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_17
+ link_16
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_18
+ link_17
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+ link_19
+ link_18
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+
\ No newline at end of file
diff --git a/worlds/iris_runway.sdf b/worlds/iris_runway.sdf
index 8f87d99e..12b88d84 100755
--- a/worlds/iris_runway.sdf
+++ b/worlds/iris_runway.sdf
@@ -115,10 +115,102 @@
-29 545 0 0 0 363
-
- model://iris_with_ardupilot
+
0 0 0.195 0 0 90
-
+
+ model://iris_with_ardupilot
+ iris
+
+
+ model://tether
+ tether
+ 0.1 0 -0.05 0 0 0
+
+
+ tether::link_00
+ iris::iris_with_standoffs::base_link
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+
+ 0 0 0 0 0 0
+
+ 0.75
+
+ 7.50000E-04
+ 0
+ 0
+ 7.50000E-04
+ 0
+ 7.50000E-04
+
+
+
+
+
+ 0.05
+
+
+
+
+
+
+ 0.05
+
+
+
+ 1 1 0
+ 1 1 0
+ 0.01 0.01 0.01 1.0
+
+
+
+
+ 0 0 0 0 0 0
+ payload_link
+ tether::link_19
+
+ 0 1 0
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+ 0 0 1
+
+ -1.57
+ 1.57
+
+
+ 0.004
+
+
+
+
+