<?xml version='1.0' encoding='utf-8'?>
<sdf xmlns:gz="http://gazebosim.org" version="1.6">
  <!--
    Modellaufbau: Links beschreiben starre Körper, Gelenke verbinden sie und Plugins
    ergänzen das Simulationsverhalten. Modell-, Link- und Gelenknamen müssen zu den
    exportierten Reglern passen.
  -->
  <model name="bluerov2">
    <!--
      Exportierte Fahrzeugkonfiguration. Das aktive Modell folgt nach diesem Kommentar. Sensoren und Anbieter im Fahrzeugeditor wählen, damit Topic-Verbindungen und Weltsysteme zusammenpassen. Einbaugrenzen: Position ±10 m, Rotation ±2π rad. recipe.json:
      {
        "control_mode": "autopilot",
        "gnss": true,
        "schema_version": 1,
        "sensors": [
          "camera",
          "camera_down",
          "ping_down"
        ],
        "settings": {
          "camera": {
            "height": 480,
            "horizontal_fov": 1.4,
            "pose": [
              0.4,
              0.0,
              -0.1,
              0.0,
              0.0,
              0.0
            ],
            "update_rate": 5,
            "width": 640
          },
          "camera_down": {
            "height": 600,
            "horizontal_fov": 1.4,
            "pose": [
              -0.1,
              0.0,
              0.0,
              0.0,
              1.5707963267948966,
              0.0
            ],
            "update_rate": 5,
            "width": 800
          },
          "ping_down": {
            "pose": [
              -0.15,
              0.0,
              -0.095,
              0.0,
              1.5707963267948966,
              0.0
            ],
            "range_max": 30,
            "update_rate": 5
          }
        },
        "vehicle": "bluerov2"
      }
    -->
    <!--
      Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
      gilt das übergeordnete Koordinatensystem.
    -->
    <pose>0 0 0 0 0 0</pose>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="base_link">
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0.0 0.0 0.011 0 0 0</pose>
        <mass>10.0</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.099</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.178</iyy>
          <iyz>0</iyz>
          <izz>0.269</izz>
        </inertia>
      </inertial>
      <!--
        Sichtbare Oberfläche für Darstellung und Kameras. Änderungen passen weder die
        Kollisionsform noch die Masse automatisch an.
      -->
      <visual name="base_link_visual">
        <geometry>
          <!--
            Mesh-Ressource mit optionaler Skalierung je Achse. Exportierten Pfad und Ressourcen
            zusammen aufbewahren; scale multipliziert die Mesh-Koordinaten.
          -->
          <mesh>
            <uri>assets/c73a7bc28f98fdcad54bf77d3ca61d26bb299e0d39be90cb56b77314d1499dde.dae</uri>
            <scale>0.025 0.025 0.025</scale>
          </mesh>
        </geometry>
      </visual>
      <!--
        Kontaktgeometrie für die Physiksimulation. Abmessungen und Lage müssen zum Rumpf
        passen; einfache Formen verringern den Rechenaufwand.
      -->
      <collision name="base_link_collision">
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0.0 0.0 0.06 0 0 0</pose>
        <geometry>
          <box>
            <size>0.457 0.338 0.065</size>
          </box>
        </geometry>
      </collision>
      <!--
        Sensor an diesem Link. pose beschreibt die Einbaulage, type wählt die
        Messimplementierung. Der Editor richtet auch Topic-Verbindungen und benötigte
        Weltsysteme ein.
      -->
      <sensor name="imu_sensor" type="imu">
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0 0 0 3.142 0 0</pose>
        <always_on>1</always_on>
        <!--
          Angeforderte Sensorfrequenz in Hz. Die erreichte Rate hängt auch von
          Simulationsgeschwindigkeit und Renderinglast ab.
        -->
        <update_rate>1000.0</update_rate>
      </sensor>
      <!--
        Sensor an diesem Link. pose beschreibt die Einbaulage, type wählt die
        Messimplementierung. Der Editor richtet auch Topic-Verbindungen und benötigte
        Weltsysteme ein.
      -->
      <sensor name="wwos_magnetometer" type="magnetometer">
        <always_on>true</always_on>
        <!--
          Angeforderte Sensorfrequenz in Hz. Die erreichte Rate hängt auch von
          Simulationsgeschwindigkeit und Renderinglast ab.
        -->
        <update_rate>20</update_rate>
        <!--
          Ausgabe-Topic von Gazebo Transport. Es muss zum exportierten Sensormanifest und zu den
          ROS-Bridge-Verbindungen passen.
        -->
        <topic>/model/bluerov2/magnetometer</topic>
      </sensor>
      <!--
        Sensor an diesem Link. pose beschreibt die Einbaulage, type wählt die
        Messimplementierung. Der Editor richtet auch Topic-Verbindungen und benötigte
        Weltsysteme ein.
      -->
      <sensor name="payload_camera" type="camera">
        <always_on>true</always_on>
        <!--
          Angeforderte Sensorfrequenz in Hz. Die erreichte Rate hängt auch von
          Simulationsgeschwindigkeit und Renderinglast ab.
        -->
        <update_rate>5</update_rate>
        <!--
          Ausgabe-Topic von Gazebo Transport. Es muss zum exportierten Sensormanifest und zu den
          ROS-Bridge-Verbindungen passen.
        -->
        <topic>/vehicle/sensors/camera</topic>
        <!--
          Kamera: horizontal_fov in Radiant, width/height in Pixeln. clip near/far begrenzen die
          Darstellung in Metern. camera_info_topic veröffentlicht Kalibrierdaten.
        -->
        <camera>
          <horizontal_fov>1.4</horizontal_fov>
          <image>
            <width>640</width>
            <height>480</height>
          </image>
          <clip>
            <near>.1</near>
            <far>100</far>
          </clip>
          <camera_info_topic>/vehicle/sensors/camera/camera_info</camera_info_topic>
        </camera>
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0.4 0.0 -0.1 0.0 0.0 0.0</pose>
        <frame_id>vehicle/camera</frame_id>
      </sensor>
      <!--
        Sensor an diesem Link. pose beschreibt die Einbaulage, type wählt die
        Messimplementierung. Der Editor richtet auch Topic-Verbindungen und benötigte
        Weltsysteme ein.
      -->
      <sensor name="payload_camera_down" type="camera">
        <always_on>true</always_on>
        <!--
          Angeforderte Sensorfrequenz in Hz. Die erreichte Rate hängt auch von
          Simulationsgeschwindigkeit und Renderinglast ab.
        -->
        <update_rate>5</update_rate>
        <!--
          Ausgabe-Topic von Gazebo Transport. Es muss zum exportierten Sensormanifest und zu den
          ROS-Bridge-Verbindungen passen.
        -->
        <topic>/vehicle/sensors/camera_down</topic>
        <!--
          Kamera: horizontal_fov in Radiant, width/height in Pixeln. clip near/far begrenzen die
          Darstellung in Metern. camera_info_topic veröffentlicht Kalibrierdaten.
        -->
        <camera>
          <horizontal_fov>1.4</horizontal_fov>
          <image>
            <width>800</width>
            <height>600</height>
          </image>
          <clip>
            <near>.1</near>
            <far>100</far>
          </clip>
          <camera_info_topic>/vehicle/sensors/camera_down/camera_info</camera_info_topic>
        </camera>
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>-0.1 0.0 0.0 0.0 1.5707963267948966 0.0</pose>
        <frame_id>vehicle/camera_down</frame_id>
      </sensor>
      <!--
        Sensor an diesem Link. pose beschreibt die Einbaulage, type wählt die
        Messimplementierung. Der Editor richtet auch Topic-Verbindungen und benötigte
        Weltsysteme ein.
      -->
      <sensor name="payload_ping_down" type="gpu_lidar">
        <always_on>true</always_on>
        <!--
          Angeforderte Sensorfrequenz in Hz. Die erreichte Rate hängt auch von
          Simulationsgeschwindigkeit und Renderinglast ab.
        -->
        <update_rate>5</update_rate>
        <!--
          Ausgabe-Topic von Gazebo Transport. Es muss zum exportierten Sensormanifest und zu den
          ROS-Bridge-Verbindungen passen.
        -->
        <topic>/vehicle/sensors/ping_down</topic>
        <!--
          Strahlbasierter Entfernungssensor. scan legt horizontale/vertikale Abtastung und
          Winkel in Radiant fest; range bestimmt Entfernungen und Auflösung in Metern. Single
          Ping nutzt diese GPU-Implementierung.
        -->
        <lidar>
          <scan>
            <horizontal>
              <samples>5</samples>
              <resolution>1</resolution>
              <min_angle>-0.00872665</min_angle>
              <max_angle>0.00872665</max_angle>
            </horizontal>
            <vertical>
              <samples>5</samples>
              <resolution>1</resolution>
              <min_angle>-0.00872665</min_angle>
              <max_angle>0.00872665</max_angle>
            </vertical>
          </scan>
          <range>
            <min>0.1</min>
            <max>30</max>
            <resolution>0.01</resolution>
          </range>
        </lidar>
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>-0.15 0.0 -0.095 0.0 1.5707963267948966 0.0</pose>
        <frame_id>vehicle/ping_down</frame_id>
      </sensor>
      <!--
        Optionaler Sensor camera: inaktives Standardbeispiel. Die aktiven payload_*-Elemente im Modell definieren die gewählten Sensoren. Auswahl im Fahrzeugeditor ändern und dieses Beispiel auskommentiert lassen. Einstellgrenzen und Ausgaben:

        update_rate: 0.1 … 30 Hz
          width: 64 … 1920 px
          height: 64 … 1920 px
          horizontal_fov: 0.1 … 3 rad
          width * height * update_rate <= 30000000 px/s

        Gazebo: /vehicle/sensors/camera
        frame_id: vehicle/camera
        ROS: /vehicle/sensors/camera (sensor_msgs/msg/Image)
        ROS: /vehicle/sensors/camera/camera_info (sensor_msgs/msg/CameraInfo)

        <sensor name="payload_camera" type="camera">
          <always_on>true</always_on>
          <update_rate>5</update_rate>
          <topic>/vehicle/sensors/camera</topic>
          <camera>
            <horizontal_fov>1.4</horizontal_fov>
            <image>
              <width>640</width>
              <height>480</height>
            </image>
            <clip>
              <near>.1</near>
              <far>100</far>
            </clip>
            <camera_info_topic>/vehicle/sensors/camera/camera_info</camera_info_topic>
          </camera>
          <pose>0.4 0.0 -0.1 0.0 0.0 0.0</pose>
          <frame_id>vehicle/camera</frame_id>
        </sensor>
      -->
      <!--
        Optionaler Sensor camera_down: inaktives Standardbeispiel. Die aktiven payload_*-Elemente im Modell definieren die gewählten Sensoren. Auswahl im Fahrzeugeditor ändern und dieses Beispiel auskommentiert lassen. Einstellgrenzen und Ausgaben:

        update_rate: 0.1 … 30 Hz
          width: 64 … 1920 px
          height: 64 … 1920 px
          horizontal_fov: 0.1 … 3 rad
          width * height * update_rate <= 30000000 px/s

        Gazebo: /vehicle/sensors/camera_down
        frame_id: vehicle/camera_down
        ROS: /vehicle/sensors/camera_down (sensor_msgs/msg/Image)
        ROS: /vehicle/sensors/camera_down/camera_info (sensor_msgs/msg/CameraInfo)

        <sensor name="payload_camera_down" type="camera">
          <always_on>true</always_on>
          <update_rate>5</update_rate>
          <topic>/vehicle/sensors/camera_down</topic>
          <camera>
            <horizontal_fov>1.4</horizontal_fov>
            <image>
              <width>800</width>
              <height>600</height>
            </image>
            <clip>
              <near>.1</near>
              <far>100</far>
            </clip>
            <camera_info_topic>/vehicle/sensors/camera_down/camera_info</camera_info_topic>
          </camera>
          <pose>-0.1 0.0 0.0 0.0 1.5707963267948966 0.0</pose>
          <frame_id>vehicle/camera_down</frame_id>
        </sensor>
      -->
      <!--
        Optionaler Sensor ping_down: inaktives Standardbeispiel. Die aktiven payload_*-Elemente im Modell definieren die gewählten Sensoren. Auswahl im Fahrzeugeditor ändern und dieses Beispiel auskommentiert lassen. Einstellgrenzen und Ausgaben:

        update_rate: 0.1 … 30 Hz
          range_max: 1 … 100 m

        Gazebo: /vehicle/sensors/ping_down
        frame_id: vehicle/ping_down
        ROS: /vehicle/sensors/ping_down (sensor_msgs/msg/LaserScan)
        ROS: /vehicle/sensors/ping_down/range (sensor_msgs/msg/Range)
        runtime: practice_ping.py

        DVL oder Single Ping wählen; beide können nicht gleichzeitig aktiv sein.

        <sensor name="payload_ping_down" type="gpu_lidar">
          <always_on>true</always_on>
          <update_rate>5</update_rate>
          <topic>/vehicle/sensors/ping_down</topic>
          <lidar>
            <scan>
              <horizontal>
                <samples>5</samples>
                <resolution>1</resolution>
                <min_angle>-0.00872665</min_angle>
                <max_angle>0.00872665</max_angle>
              </horizontal>
              <vertical>
                <samples>5</samples>
                <resolution>1</resolution>
                <min_angle>-0.00872665</min_angle>
                <max_angle>0.00872665</max_angle>
              </vertical>
            </scan>
            <range>
              <min>0.1</min>
              <max>30</max>
              <resolution>0.01</resolution>
            </range>
          </lidar>
          <pose>-0.15 0.0 -0.095 0.0 1.5707963267948966 0.0</pose>
          <frame_id>vehicle/ping_down</frame_id>
        </sensor>
      -->
      <!--
        Optionaler Sensor multibeam_forward: inaktives Standardbeispiel. Die aktiven payload_*-Elemente im Modell definieren die gewählten Sensoren. Auswahl im Fahrzeugeditor ändern und dieses Beispiel auskommentiert lassen. Einstellgrenzen und Ausgaben:

        update_rate: 0.1 … 30 Hz

        Gazebo: /vehicle/sensors/multibeam_forward
        frame_id: vehicle/multibeam_forward
        ROS: /vehicle/sensors/multibeam_forward/sonar_image_raw (marine_acoustic_msgs/msg/ProjectedSonarImage)

        Benötigt einen kompatiblen akustischen Sonaranbieter für POSIM und dessen Weltsystem. Das Beispiel bleibt ohne Anbieter als Referenz erhalten. Strahl- und Akustikwerte sind Anbieter-Standardwerte; der Editor bietet Frequenz und Pose an.

        <sensor xmlns:gz="http://gazebosim.org" name="payload_multibeam_forward" type="custom" gz:type="multibeam_sonar">
          <always_on>true</always_on>
          <update_rate>2</update_rate>
          <topic>/vehicle/sensors/multibeam_forward</topic>
          <visualize>true</visualize>
          <gz:multibeam_sonar>
            <ray degrees="false">
              <scan>
                <horizontal>
                  <beams>256</beams>
                  <min_angle>-1.0471975511965976</min_angle>
                  <max_angle>1.0471975511965976</max_angle>
                </horizontal>
                <vertical>
                  <rays>256</rays>
                  <min_angle>-0.17453292519943295</min_angle>
                  <max_angle>0.17453292519943295</max_angle>
                </vertical>
              </scan>
              <range>
                <min>0.2</min>
                <max>15</max>
              </range>
            </ray>
            <spec>
              <verticalFOV>20</verticalFOV>
              <sonarFreq>700e3</sonarFreq>
              <bandwidth>29.9e3</bandwidth>
              <soundSpeed>1500</soundSpeed>
              <sourceLevel>220</sourceLevel>
              <maxDistance>15</maxDistance>
              <raySkips>1</raySkips>
              <sensorGain>0.02</sensorGain>
              <writeLog>false</writeLog>
              <debugFlag>false</debugFlag>
              <writeFrameInterval>5</writeFrameInterval>
              <pointCloudTopicName>geometry/points</pointCloudTopicName>
              <sonarImageRawTopicName>sonar_image_raw</sonarImageRawTopicName>
              <sonarImageTopicName>sonar_image</sonarImageTopicName>
              <frameName>vehicle/multibeam_forward</frameName>
              <visibilityMask>3892314111</visibilityMask>
            </spec>
          </gz:multibeam_sonar>
          <pose>0.24 0.0 -0.1 0.0 0.35 0.0</pose>
          <frame_id>vehicle/multibeam_forward</frame_id>
        </sensor>
      -->
      <!--
        Optionaler Sensor dvl: inaktives Standardbeispiel. Die aktiven payload_*-Elemente im Modell definieren die gewählten Sensoren. Auswahl im Fahrzeugeditor ändern und dieses Beispiel auskommentiert lassen. Einstellgrenzen und Ausgaben:

        update_rate: 0.1 … 30 Hz
          range_max: 1 … 100 m

        Gazebo: /vehicle/sensors/dvl
        frame_id: vehicle/dvl
        ROS: /vehicle/sensors/dvl/velocity (geometry_msgs/msg/Vector3Stamped)
        ROS: /vehicle/sensors/dvl/status (std_msgs/msg/String)
        runtime: practice_dvl_bridge.py

        DVL oder Single Ping wählen; beide können nicht gleichzeitig aktiv sein.

        <sensor xmlns:gz="http://gazebosim.org" name="payload_dvl" type="custom" gz:type="dvl">
          <pose>0.0 0.0 -0.12 0.0 0.0 0.0</pose>
          <always_on>true</always_on>
          <update_rate>1</update_rate>
          <topic>/vehicle/sensors/dvl</topic>
          <gz:dvl>
            <type>phased_array</type>
            <arrangement degrees="true">
              <beam id="1">
                <aperture>2</aperture>
                <rotation>45</rotation>
                <tilt>30</tilt>
              </beam>
              <beam id="2">
                <aperture>2</aperture>
                <rotation>135</rotation>
                <tilt>30</tilt>
              </beam>
              <beam id="3">
                <aperture>2</aperture>
                <rotation>-45</rotation>
                <tilt>30</tilt>
              </beam>
              <beam id="4">
                <aperture>2</aperture>
                <rotation>-135</rotation>
                <tilt>30</tilt>
              </beam>
            </arrangement>
            <tracking>
              <bottom_mode>
                <when>best</when>
                <noise type="gaussian">
                  <stddev>0.002</stddev>
                </noise>
                <visualize>false</visualize>
              </bottom_mode>
            </tracking>
            <resolution>0.01</resolution>
            <maximum_range>20</maximum_range>
            <minimum_range>0.1</minimum_range>
            <reference_frame>0 0 0 0 0 0</reference_frame>
          </gz:dvl>
          <frame_id>vehicle/dvl</frame_id>
        </sensor>
      -->
    </link>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="camera_link">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose relative_to="camera_mount_link">0 0 0 0 0 0</pose>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>0.0001</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.0001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.0001</iyy>
          <iyz>0</iyz>
          <izz>0.0001</izz>
        </inertia>
      </inertial>
    </link>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="camera_mount_link">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose relative_to="base_link">0.19 0 0.067 0 0 0</pose>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>0.0001</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.0001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.0001</iyy>
          <iyz>0</iyz>
          <izz>0.0001</izz>
        </inertia>
      </inertial>
    </link>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="camera_joint" type="fixed">
      <parent>camera_mount_link</parent>
      <child>camera_link</child>
    </joint>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="camera_mount_joint" type="fixed">
      <parent>base_link</parent>
      <child>camera_mount_link</child>
    </joint>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="thruster1">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose>0.14 -0.092 0.0 -1.571 1.571 -0.785</pose>
      <!--
        Sichtbare Oberfläche für Darstellung und Kameras. Änderungen passen weder die
        Kollisionsform noch die Masse automatisch an.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0 0 0 -1.571 0 0</pose>
        <geometry>
          <!--
            Mesh-Ressource mit optionaler Skalierung je Achse. Exportierten Pfad und Ressourcen
            zusammen aufbewahren; scale multipliziert die Mesh-Koordinaten.
          -->
          <mesh>
            <uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.001</iyy>
          <iyz>0</iyz>
          <izz>0.001</izz>
        </inertia>
      </inertial>
    </link>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="thruster2">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose>0.14 0.092 0.0 -1.571 1.571 -2.356</pose>
      <!--
        Sichtbare Oberfläche für Darstellung und Kameras. Änderungen passen weder die
        Kollisionsform noch die Masse automatisch an.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0 0 0 -1.571 0 0</pose>
        <geometry>
          <!--
            Mesh-Ressource mit optionaler Skalierung je Achse. Exportierten Pfad und Ressourcen
            zusammen aufbewahren; scale multipliziert die Mesh-Koordinaten.
          -->
          <mesh>
            <uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.001</iyy>
          <iyz>0</iyz>
          <izz>0.001</izz>
        </inertia>
      </inertial>
    </link>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="thruster3">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose>-0.15 -0.092 0.0 -1.571 1.571 0.785</pose>
      <!--
        Sichtbare Oberfläche für Darstellung und Kameras. Änderungen passen weder die
        Kollisionsform noch die Masse automatisch an.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0 0 0 1.571 0 0</pose>
        <geometry>
          <!--
            Mesh-Ressource mit optionaler Skalierung je Achse. Exportierten Pfad und Ressourcen
            zusammen aufbewahren; scale multipliziert die Mesh-Koordinaten.
          -->
          <mesh>
            <uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.001</iyy>
          <iyz>0</iyz>
          <izz>0.001</izz>
        </inertia>
      </inertial>
    </link>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="thruster4">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose>-0.15 0.092 0.0 -1.571 1.571 2.356</pose>
      <!--
        Sichtbare Oberfläche für Darstellung und Kameras. Änderungen passen weder die
        Kollisionsform noch die Masse automatisch an.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0 0 0 1.571 0 0</pose>
        <geometry>
          <!--
            Mesh-Ressource mit optionaler Skalierung je Achse. Exportierten Pfad und Ressourcen
            zusammen aufbewahren; scale multipliziert die Mesh-Koordinaten.
          -->
          <mesh>
            <uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.001</iyy>
          <iyz>0</iyz>
          <izz>0.001</izz>
        </inertia>
      </inertial>
    </link>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="thruster5">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose>0.0 -0.109 0.077 0 0 0</pose>
      <!--
        Sichtbare Oberfläche für Darstellung und Kameras. Änderungen passen weder die
        Kollisionsform noch die Masse automatisch an.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0 0 0 -1.571 0 1.571</pose>
        <geometry>
          <!--
            Mesh-Ressource mit optionaler Skalierung je Achse. Exportierten Pfad und Ressourcen
            zusammen aufbewahren; scale multipliziert die Mesh-Koordinaten.
          -->
          <mesh>
            <uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.001</iyy>
          <iyz>0</iyz>
          <izz>0.001</izz>
        </inertia>
      </inertial>
    </link>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="thruster6">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose>0.0 0.109 0.077 0 0 0</pose>
      <!--
        Sichtbare Oberfläche für Darstellung und Kameras. Änderungen passen weder die
        Kollisionsform noch die Masse automatisch an.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
          gilt das übergeordnete Koordinatensystem.
        -->
        <pose>0 0 0 1.571 0 1.571</pose>
        <geometry>
          <!--
            Mesh-Ressource mit optionaler Skalierung je Achse. Exportierten Pfad und Ressourcen
            zusammen aufbewahren; scale multipliziert die Mesh-Koordinaten.
          -->
          <mesh>
            <uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.001</iyy>
          <iyz>0</iyz>
          <izz>0.001</izz>
        </inertia>
      </inertial>
    </link>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="thruster1_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster1</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="thruster2_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster2</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="thruster3_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster3</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="thruster4_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster4</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="thruster5_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster5</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="thruster6_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster6</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      Propellerschub: fluid_density in kg/m^3, propeller_diameter in Metern.
      thrust_coefficient verknüpft Winkelgeschwindigkeit und Schub. use_angvel_cmd=true
      erwartet rad/s, false erwartet Kraft in N.
    -->
    <plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
      <namespace>bluerov2</namespace>
      <joint_name>thruster1_joint</joint_name>
      <thrust_coefficient>0.02</thrust_coefficient>
      <fluid_density>1025.0</fluid_density>
      <propeller_diameter>0.1</propeller_diameter>
      <velocity_control>true</velocity_control>
      <use_angvel_cmd>False</use_angvel_cmd>
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      Propellerschub: fluid_density in kg/m^3, propeller_diameter in Metern.
      thrust_coefficient verknüpft Winkelgeschwindigkeit und Schub. use_angvel_cmd=true
      erwartet rad/s, false erwartet Kraft in N.
    -->
    <plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
      <namespace>bluerov2</namespace>
      <joint_name>thruster2_joint</joint_name>
      <thrust_coefficient>0.02</thrust_coefficient>
      <fluid_density>1025.0</fluid_density>
      <propeller_diameter>0.1</propeller_diameter>
      <velocity_control>true</velocity_control>
      <use_angvel_cmd>False</use_angvel_cmd>
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      Propellerschub: fluid_density in kg/m^3, propeller_diameter in Metern.
      thrust_coefficient verknüpft Winkelgeschwindigkeit und Schub. use_angvel_cmd=true
      erwartet rad/s, false erwartet Kraft in N.
    -->
    <plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
      <namespace>bluerov2</namespace>
      <joint_name>thruster3_joint</joint_name>
      <thrust_coefficient>-0.02</thrust_coefficient>
      <fluid_density>1025.0</fluid_density>
      <propeller_diameter>0.1</propeller_diameter>
      <velocity_control>true</velocity_control>
      <use_angvel_cmd>False</use_angvel_cmd>
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      Propellerschub: fluid_density in kg/m^3, propeller_diameter in Metern.
      thrust_coefficient verknüpft Winkelgeschwindigkeit und Schub. use_angvel_cmd=true
      erwartet rad/s, false erwartet Kraft in N.
    -->
    <plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
      <namespace>bluerov2</namespace>
      <joint_name>thruster4_joint</joint_name>
      <thrust_coefficient>-0.02</thrust_coefficient>
      <fluid_density>1025.0</fluid_density>
      <propeller_diameter>0.1</propeller_diameter>
      <velocity_control>true</velocity_control>
      <use_angvel_cmd>False</use_angvel_cmd>
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      Propellerschub: fluid_density in kg/m^3, propeller_diameter in Metern.
      thrust_coefficient verknüpft Winkelgeschwindigkeit und Schub. use_angvel_cmd=true
      erwartet rad/s, false erwartet Kraft in N.
    -->
    <plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
      <namespace>bluerov2</namespace>
      <joint_name>thruster5_joint</joint_name>
      <thrust_coefficient>0.02</thrust_coefficient>
      <fluid_density>1025.0</fluid_density>
      <propeller_diameter>0.1</propeller_diameter>
      <velocity_control>true</velocity_control>
      <use_angvel_cmd>False</use_angvel_cmd>
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      Propellerschub: fluid_density in kg/m^3, propeller_diameter in Metern.
      thrust_coefficient verknüpft Winkelgeschwindigkeit und Schub. use_angvel_cmd=true
      erwartet rad/s, false erwartet Kraft in N.
    -->
    <plugin filename="gz-sim-thruster-system" name="gz::sim::systems::Thruster">
      <namespace>bluerov2</namespace>
      <joint_name>thruster6_joint</joint_name>
      <thrust_coefficient>-0.02</thrust_coefficient>
      <fluid_density>1025.0</fluid_density>
      <propeller_diameter>0.1</propeller_diameter>
      <velocity_control>true</velocity_control>
      <use_angvel_cmd>False</use_angvel_cmd>
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      ArduPilot-Anbindung: Netzwerkadresse, schrittsynchrone Zeitsteuerung,
      Koordinatentransformationen und IMU-Name. Diese Verbindungen bei Änderungen an
      Fahrzeugparametern beibehalten.
    -->
    <plugin name="ArduPilotPlugin" filename="libArduPilotPlugin.so">
      <fdm_addr>127.0.0.1</fdm_addr>
      <fdm_port_in>9002</fdm_port_in>
      <connectionTimeoutMaxCount>5</connectionTimeoutMaxCount>
      <lock_step>1</lock_step>
      <modelXYZToAirplaneXForwardZDown>0 0 0 3.142 0 0</modelXYZToAirplaneXForwardZDown>
      <gazeboXYZToNED>0 0 0 3.142 0 1.571</gazeboXYZToNED>
      <imuName>imu_sensor</imuName>
      <!--
        Ordnet einen Reglerkanal einem Gelenk-Topic zu. servo_min/max legen den
        Eingangsbereich fest, offset und multiplier den Versatz und die Skalierung der
        Ausgabe. Kanal- und Topic-Zuordnung beibehalten.
      -->
      <control channel="0">
        <jointName>thruster1_joint</jointName>
        <servo_min>1100</servo_min>
        <servo_max>1900</servo_max>
        <type>COMMAND</type>
        <cmd_topic>/model/bluerov2/joint/thruster1_joint/cmd_thrust</cmd_topic>
        <offset>-0.5</offset>
        <multiplier>100</multiplier>
      </control>
      <!--
        Ordnet einen Reglerkanal einem Gelenk-Topic zu. servo_min/max legen den
        Eingangsbereich fest, offset und multiplier den Versatz und die Skalierung der
        Ausgabe. Kanal- und Topic-Zuordnung beibehalten.
      -->
      <control channel="1">
        <jointName>thruster2_joint</jointName>
        <servo_min>1100</servo_min>
        <servo_max>1900</servo_max>
        <type>COMMAND</type>
        <cmd_topic>/model/bluerov2/joint/thruster2_joint/cmd_thrust</cmd_topic>
        <offset>-0.5</offset>
        <multiplier>100</multiplier>
      </control>
      <!--
        Ordnet einen Reglerkanal einem Gelenk-Topic zu. servo_min/max legen den
        Eingangsbereich fest, offset und multiplier den Versatz und die Skalierung der
        Ausgabe. Kanal- und Topic-Zuordnung beibehalten.
      -->
      <control channel="2">
        <jointName>thruster3_joint</jointName>
        <servo_min>1100</servo_min>
        <servo_max>1900</servo_max>
        <type>COMMAND</type>
        <cmd_topic>/model/bluerov2/joint/thruster3_joint/cmd_thrust</cmd_topic>
        <offset>-0.5</offset>
        <multiplier>100</multiplier>
      </control>
      <!--
        Ordnet einen Reglerkanal einem Gelenk-Topic zu. servo_min/max legen den
        Eingangsbereich fest, offset und multiplier den Versatz und die Skalierung der
        Ausgabe. Kanal- und Topic-Zuordnung beibehalten.
      -->
      <control channel="3">
        <jointName>thruster4_joint</jointName>
        <servo_min>1100</servo_min>
        <servo_max>1900</servo_max>
        <type>COMMAND</type>
        <cmd_topic>/model/bluerov2/joint/thruster4_joint/cmd_thrust</cmd_topic>
        <offset>-0.5</offset>
        <multiplier>100</multiplier>
      </control>
      <!--
        Ordnet einen Reglerkanal einem Gelenk-Topic zu. servo_min/max legen den
        Eingangsbereich fest, offset und multiplier den Versatz und die Skalierung der
        Ausgabe. Kanal- und Topic-Zuordnung beibehalten.
      -->
      <control channel="4">
        <jointName>thruster5_joint</jointName>
        <servo_min>1100</servo_min>
        <servo_max>1900</servo_max>
        <type>COMMAND</type>
        <cmd_topic>/model/bluerov2/joint/thruster5_joint/cmd_thrust</cmd_topic>
        <offset>-0.5</offset>
        <multiplier>100</multiplier>
      </control>
      <!--
        Ordnet einen Reglerkanal einem Gelenk-Topic zu. servo_min/max legen den
        Eingangsbereich fest, offset und multiplier den Versatz und die Skalierung der
        Ausgabe. Kanal- und Topic-Zuordnung beibehalten.
      -->
      <control channel="5">
        <jointName>thruster6_joint</jointName>
        <servo_min>1100</servo_min>
        <servo_max>1900</servo_max>
        <type>COMMAND</type>
        <cmd_topic>/model/bluerov2/joint/thruster6_joint/cmd_thrust</cmd_topic>
        <offset>-0.5</offset>
        <multiplier>100</multiplier>
      </control>
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      Publiziert simulierte Odometrie mit den angegebenen Koordinatensystemen und der
      Frequenz in Hz. Sie beschreibt den Simulatorzustand; simulierte Messungen liefern die
      Sensor-Topics.
    -->
    <plugin filename="gz-sim-odometry-publisher-system" name="gz::sim::systems::OdometryPublisher">
      <odom_frame>map</odom_frame>
      <robot_base_frame>base_link</robot_base_frame>
      <dimensions>3</dimensions>
      <odom_publish_frequency>100</odom_publish_frequency>
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <plugin filename="gz-sim-joint-state-publisher-system" name="gz::sim::systems::JointStatePublisher">
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <plugin filename="gz-sim-imu-system" name="gz::sim::systems::Imu">
    </plugin>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <plugin filename="gz-waves1-hydrodynamics-system" name="gz::sim::systems::Hydrodynamics">
      <enable>bluerov2::base_link</enable>
      <!--
        Koeffizienten der Wasserkräfte. damping_on, viscous_drag_on und pressure_drag_on
        aktivieren die jeweiligen Anteile. cDampL/R steuern lineare/rotatorische Dämpfung;
        Druckwiderstandskoeffizienten gelten für dieses Plugin-Modell.
      -->
      <hydrodynamics>
        <damping_on>1</damping_on>
        <viscous_drag_on>0</viscous_drag_on>
        <pressure_drag_on>0</pressure_drag_on>
        <cDampL1>.1</cDampL1>
        <cDampL2>40</cDampL2>
        <cDampR1>.1</cDampR1>
        <cDampR2>4</cDampR2>
      </hydrodynamics>
    </plugin>
    <!--
      Starrer Körper mit lokalem Koordinatensystem. Geometrie, Masseneigenschaften und
      Sensoren dieses Links bewegen sich gemeinsam.
    -->
    <link name="gnss_link">
      <!--
        Pose: x y z in Metern, danach Roll-, Nick- und Gierwinkel in Radiant. Ohne relative_to
        gilt das übergeordnete Koordinatensystem.
      -->
      <pose relative_to="base_link">0 0 0.3 0 0 0</pose>
      <!--
        Masseneigenschaften: mass in kg; pose legt Lage und Orientierung des
        Schwerpunktsystems relativ zum Link fest. Messwerte oder CAD-Berechnungen verwenden.
      -->
      <inertial>
        <mass>.001</mass>
        <!--
          Trägheitstensor am Schwerpunkt in kg*m^2. ixx/iyy/izz sind Diagonaleinträge,
          ixy/ixz/iyz Kreuzterme. Der Tensor muss physikalisch zu Masse und Form passen.
        -->
        <inertia>
          <ixx>0.000001</ixx>
          <iyy>0.000001</iyy>
          <izz>0.000001</izz>
        </inertia>
      </inertial>
      <!--
        Sensor an diesem Link. pose beschreibt die Einbaulage, type wählt die
        Messimplementierung. Der Editor richtet auch Topic-Verbindungen und benötigte
        Weltsysteme ein.
      -->
      <sensor name="gnss" type="custom" gz:type="posim_gnss">
        <always_on>true</always_on>
        <!--
          Angeforderte Sensorfrequenz in Hz. Die erreichte Rate hängt auch von
          Simulationsgeschwindigkeit und Renderinglast ab.
        -->
        <update_rate>5</update_rate>
        <!--
          Ausgabe-Topic von Gazebo Transport. Es muss zum exportierten Sensormanifest und zu den
          ROS-Bridge-Verbindungen passen.
        -->
        <topic>/model/bluerov2/gnss</topic>
      </sensor>
    </link>
    <!--
      Gelenk zwischen parent und child. fixed verhindert relative Bewegung, revolute erlaubt
      Rotation um axis/xyz. Namen für Antriebs- und Regler-Plugins beibehalten.
    -->
    <joint name="gnss_joint" type="fixed">
      <parent>base_link</parent>
      <child>gnss_link</child>
    </joint>
    <!--
      Engine-Plugin. filename verweist auf eine installierte Bibliothek, name auf deren
      Implementierung. Bei numerischen Änderungen beide beibehalten; eine SDF-Datei
      installiert keine Plugins.
    -->
    <!--
      GNSS-Empfängermodell. update_rate in Hz, latency und reacquire_seconds in Sekunden.
      Positionsrauschen und dry_margin in Metern, velocity_stddev in m/s. link_name, topic
      und wave_topic verbinden Antenne, Ausgabe und Wasseroberfläche.
    -->
    <plugin name="posim::Gnss" filename="libposim_gnss.so">
      <update_rate>5</update_rate>
      <latency>0.2</latency>
      <reacquire_seconds>3</reacquire_seconds>
      <dry_margin>0.05</dry_margin>
      <horizontal_stddev>0.7</horizontal_stddev>
      <vertical_stddev>1.2</vertical_stddev>
      <velocity_stddev>0.1</velocity_stddev>
      <water_level>0</water_level>
      <seed>42</seed>
      <enabled>true</enabled>
      <link_name>gnss_link</link_name>
      <topic>/model/bluerov2/gnss</topic>
      <wave_topic>/wwos/wave_surface</wave_topic>
    </plugin>
  </model>
</sdf>
