<?xml version='1.0' encoding='utf-8'?>
<sdf xmlns:gz="http://gazebosim.org" version="1.6">
  <!--
    Struttura del modello: i link definiscono corpi rigidi, i giunti li collegano e i
    plugin ne simulano il comportamento. Mantieni i nomi usati dai controllori esportati.
  -->
  <model name="bluerov2">
    <!--
      Configurazione esportata del veicolo. Il modello attivo segue questo commento. Seleziona sensori e provider nell'editor per mantenere coerenti topic e sistemi del mondo. Limiti di montaggio: posizione ±10 m; rotazione ±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"
      }
    -->
    <!--
      Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
      genitore, salvo diversa indicazione in relative_to.
    -->
    <pose>0 0 0 0 0 0</pose>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="base_link">
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0.0 0.0 0.011 0 0 0</pose>
        <mass>10.0</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <inertia>
          <ixx>0.099</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.178</iyy>
          <iyz>0</iyz>
          <izz>0.269</izz>
        </inertia>
      </inertial>
      <!--
        Superficie visibile nel rendering e nelle camere. Le modifiche non aggiornano
        automaticamente la forma di collisione o la massa.
      -->
      <visual name="base_link_visual">
        <geometry>
          <!--
            Risorsa mesh e scala facoltativa per asse. Conserva il percorso esportato insieme ai
            file; scale moltiplica le coordinate della mesh.
          -->
          <mesh>
            <uri>assets/c73a7bc28f98fdcad54bf77d3ca61d26bb299e0d39be90cb56b77314d1499dde.dae</uri>
            <scale>0.025 0.025 0.025</scale>
          </mesh>
        </geometry>
      </visual>
      <!--
        Geometria di contatto usata dalla fisica. Dimensioni e posizione devono corrispondere
        allo scafo; una forma semplice riduce il costo delle collisioni.
      -->
      <collision name="base_link_collision">
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0.0 0.0 0.06 0 0 0</pose>
        <geometry>
          <box>
            <size>0.457 0.338 0.065</size>
          </box>
        </geometry>
      </collision>
      <!--
        Sensore fissato a questo link. pose definisce il montaggio e type seleziona la misura.
        L'editor prepara anche i topic e i sistemi necessari nel mondo.
      -->
      <sensor name="imu_sensor" type="imu">
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0 0 0 3.142 0 0</pose>
        <always_on>1</always_on>
        <!--
          Frequenza di aggiornamento richiesta, in Hz. Quella effettiva dipende anche dalla
          velocità della simulazione e dal carico grafico.
        -->
        <update_rate>1000.0</update_rate>
      </sensor>
      <!--
        Sensore fissato a questo link. pose definisce il montaggio e type seleziona la misura.
        L'editor prepara anche i topic e i sistemi necessari nel mondo.
      -->
      <sensor name="wwos_magnetometer" type="magnetometer">
        <always_on>true</always_on>
        <!--
          Frequenza di aggiornamento richiesta, in Hz. Quella effettiva dipende anche dalla
          velocità della simulazione e dal carico grafico.
        -->
        <update_rate>20</update_rate>
        <!--
          Topic di uscita di Gazebo Transport. Deve corrispondere al manifest dei sensori e alle
          rotte del bridge ROS esportati.
        -->
        <topic>/model/bluerov2/magnetometer</topic>
      </sensor>
      <!--
        Sensore fissato a questo link. pose definisce il montaggio e type seleziona la misura.
        L'editor prepara anche i topic e i sistemi necessari nel mondo.
      -->
      <sensor name="payload_camera" type="camera">
        <always_on>true</always_on>
        <!--
          Frequenza di aggiornamento richiesta, in Hz. Quella effettiva dipende anche dalla
          velocità della simulazione e dal carico grafico.
        -->
        <update_rate>5</update_rate>
        <!--
          Topic di uscita di Gazebo Transport. Deve corrispondere al manifest dei sensori e alle
          rotte del bridge ROS esportati.
        -->
        <topic>/vehicle/sensors/camera</topic>
        <!--
          Camera: horizontal_fov è in radianti; width/height in pixel. clip near/far delimitano
          il rendering in metri. camera_info_topic pubblica i dati di calibrazione.
        -->
        <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>
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0.4 0.0 -0.1 0.0 0.0 0.0</pose>
        <frame_id>vehicle/camera</frame_id>
      </sensor>
      <!--
        Sensore fissato a questo link. pose definisce il montaggio e type seleziona la misura.
        L'editor prepara anche i topic e i sistemi necessari nel mondo.
      -->
      <sensor name="payload_camera_down" type="camera">
        <always_on>true</always_on>
        <!--
          Frequenza di aggiornamento richiesta, in Hz. Quella effettiva dipende anche dalla
          velocità della simulazione e dal carico grafico.
        -->
        <update_rate>5</update_rate>
        <!--
          Topic di uscita di Gazebo Transport. Deve corrispondere al manifest dei sensori e alle
          rotte del bridge ROS esportati.
        -->
        <topic>/vehicle/sensors/camera_down</topic>
        <!--
          Camera: horizontal_fov è in radianti; width/height in pixel. clip near/far delimitano
          il rendering in metri. camera_info_topic pubblica i dati di calibrazione.
        -->
        <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>
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>-0.1 0.0 0.0 0.0 1.5707963267948966 0.0</pose>
        <frame_id>vehicle/camera_down</frame_id>
      </sensor>
      <!--
        Sensore fissato a questo link. pose definisce il montaggio e type seleziona la misura.
        L'editor prepara anche i topic e i sistemi necessari nel mondo.
      -->
      <sensor name="payload_ping_down" type="gpu_lidar">
        <always_on>true</always_on>
        <!--
          Frequenza di aggiornamento richiesta, in Hz. Quella effettiva dipende anche dalla
          velocità della simulazione e dal carico grafico.
        -->
        <update_rate>5</update_rate>
        <!--
          Topic di uscita di Gazebo Transport. Deve corrispondere al manifest dei sensori e alle
          rotte del bridge ROS esportati.
        -->
        <topic>/vehicle/sensors/ping_down</topic>
        <!--
          Sensore di distanza basato su raggi. scan definisce campioni e angoli
          orizzontali/verticali in radianti; range imposta distanze e risoluzione in metri.
          Single Ping usa questa implementazione GPU.
        -->
        <lidar>
          <scan>
            <horizontal>
              <samples>5</samples>
              <resolution>1</resolution>
              <min_angle>-0.00872665</min_angle>
              <max_angle>0.00872665</max_angle>
            </horizontal>
            <vertical>
              <samples>5</samples>
              <resolution>1</resolution>
              <min_angle>-0.00872665</min_angle>
              <max_angle>0.00872665</max_angle>
            </vertical>
          </scan>
          <range>
            <min>0.1</min>
            <max>30</max>
            <resolution>0.01</resolution>
          </range>
        </lidar>
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>-0.15 0.0 -0.095 0.0 1.5707963267948966 0.0</pose>
        <frame_id>vehicle/ping_down</frame_id>
      </sensor>
      <!--
        Sensore facoltativo camera: esempio predefinito inattivo. Gli elementi payload_* attivi del modello definiscono i sensori selezionati. Modifica la selezione nell'editor e lascia questo esempio nel commento. Limiti modificabili e uscite:

        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>
      -->
      <!--
        Sensore facoltativo camera_down: esempio predefinito inattivo. Gli elementi payload_* attivi del modello definiscono i sensori selezionati. Modifica la selezione nell'editor e lascia questo esempio nel commento. Limiti modificabili e uscite:

        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>
      -->
      <!--
        Sensore facoltativo ping_down: esempio predefinito inattivo. Gli elementi payload_* attivi del modello definiscono i sensori selezionati. Modifica la selezione nell'editor e lascia questo esempio nel commento. Limiti modificabili e uscite:

        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

        Scegli DVL oppure Single Ping; non possono essere attivi insieme.

        <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>
      -->
      <!--
        Sensore facoltativo multibeam_forward: esempio predefinito inattivo. Gli elementi payload_* attivi del modello definiscono i sensori selezionati. Modifica la selezione nell'editor e lascia questo esempio nel commento. Limiti modificabili e uscite:

        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)

        Richiede un provider sonar acustico compatibile con POSIM e il suo sistema del mondo. L'esempio resta un riferimento anche senza il provider. I campi acustici e dei raggi sono valori predefiniti del provider; l'editor espone frequenza e posa.

        <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>
      -->
      <!--
        Sensore facoltativo dvl: esempio predefinito inattivo. Gli elementi payload_* attivi del modello definiscono i sensori selezionati. Modifica la selezione nell'editor e lascia questo esempio nel commento. Limiti modificabili e uscite:

        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

        Scegli DVL oppure Single Ping; non possono essere attivi insieme.

        <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>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="camera_link">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose relative_to="camera_mount_link">0 0 0 0 0 0</pose>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>0.0001</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <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>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="camera_mount_link">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose relative_to="base_link">0.19 0 0.067 0 0 0</pose>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>0.0001</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <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>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="camera_joint" type="fixed">
      <parent>camera_mount_link</parent>
      <child>camera_link</child>
    </joint>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="camera_mount_joint" type="fixed">
      <parent>base_link</parent>
      <child>camera_mount_link</child>
    </joint>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="thruster1">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose>0.14 -0.092 0.0 -1.571 1.571 -0.785</pose>
      <!--
        Superficie visibile nel rendering e nelle camere. Le modifiche non aggiornano
        automaticamente la forma di collisione o la massa.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0 0 0 -1.571 0 0</pose>
        <geometry>
          <!--
            Risorsa mesh e scala facoltativa per asse. Conserva il percorso esportato insieme ai
            file; scale moltiplica le coordinate della mesh.
          -->
          <mesh>
            <uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <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>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="thruster2">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose>0.14 0.092 0.0 -1.571 1.571 -2.356</pose>
      <!--
        Superficie visibile nel rendering e nelle camere. Le modifiche non aggiornano
        automaticamente la forma di collisione o la massa.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0 0 0 -1.571 0 0</pose>
        <geometry>
          <!--
            Risorsa mesh e scala facoltativa per asse. Conserva il percorso esportato insieme ai
            file; scale moltiplica le coordinate della mesh.
          -->
          <mesh>
            <uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <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>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="thruster3">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose>-0.15 -0.092 0.0 -1.571 1.571 0.785</pose>
      <!--
        Superficie visibile nel rendering e nelle camere. Le modifiche non aggiornano
        automaticamente la forma di collisione o la massa.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0 0 0 1.571 0 0</pose>
        <geometry>
          <!--
            Risorsa mesh e scala facoltativa per asse. Conserva il percorso esportato insieme ai
            file; scale moltiplica le coordinate della mesh.
          -->
          <mesh>
            <uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <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>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="thruster4">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose>-0.15 0.092 0.0 -1.571 1.571 2.356</pose>
      <!--
        Superficie visibile nel rendering e nelle camere. Le modifiche non aggiornano
        automaticamente la forma di collisione o la massa.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0 0 0 1.571 0 0</pose>
        <geometry>
          <!--
            Risorsa mesh e scala facoltativa per asse. Conserva il percorso esportato insieme ai
            file; scale moltiplica le coordinate della mesh.
          -->
          <mesh>
            <uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <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>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="thruster5">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose>0.0 -0.109 0.077 0 0 0</pose>
      <!--
        Superficie visibile nel rendering e nelle camere. Le modifiche non aggiornano
        automaticamente la forma di collisione o la massa.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0 0 0 -1.571 0 1.571</pose>
        <geometry>
          <!--
            Risorsa mesh e scala facoltativa per asse. Conserva il percorso esportato insieme ai
            file; scale moltiplica le coordinate della mesh.
          -->
          <mesh>
            <uri>assets/4c4ae10284584339de36be62165caca9464a8df8ec1e81567d08180b3531d643.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <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>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="thruster6">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose>0.0 0.109 0.077 0 0 0</pose>
      <!--
        Superficie visibile nel rendering e nelle camere. Le modifiche non aggiornano
        automaticamente la forma di collisione o la massa.
      -->
      <visual name="thruster_prop_visual">
        <!--
          Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
          genitore, salvo diversa indicazione in relative_to.
        -->
        <pose>0 0 0 1.571 0 1.571</pose>
        <geometry>
          <!--
            Risorsa mesh e scala facoltativa per asse. Conserva il percorso esportato insieme ai
            file; scale moltiplica le coordinate della mesh.
          -->
          <mesh>
            <uri>assets/c4b609828a11b8387f2d49c1de4bd37e911767c38f948144f84a0fc9c29a9a54.dae</uri>
          </mesh>
        </geometry>
      </visual>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>0.002</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <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>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="thruster1_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster1</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="thruster2_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster2</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="thruster3_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster3</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="thruster4_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster4</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="thruster5_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster5</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="thruster6_joint" type="revolute">
      <parent>base_link</parent>
      <child>thruster6</child>
      <axis>
        <xyz>0 0 -1</xyz>
      </axis>
    </joint>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Modello di spinta: fluid_density è in kg/m^3, propeller_diameter in metri;
      thrust_coefficient lega velocità angolare e spinta. use_angvel_cmd=true riceve rad/s,
      false riceve forza 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>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Modello di spinta: fluid_density è in kg/m^3, propeller_diameter in metri;
      thrust_coefficient lega velocità angolare e spinta. use_angvel_cmd=true riceve rad/s,
      false riceve forza 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>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Modello di spinta: fluid_density è in kg/m^3, propeller_diameter in metri;
      thrust_coefficient lega velocità angolare e spinta. use_angvel_cmd=true riceve rad/s,
      false riceve forza 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>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Modello di spinta: fluid_density è in kg/m^3, propeller_diameter in metri;
      thrust_coefficient lega velocità angolare e spinta. use_angvel_cmd=true riceve rad/s,
      false riceve forza 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>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Modello di spinta: fluid_density è in kg/m^3, propeller_diameter in metri;
      thrust_coefficient lega velocità angolare e spinta. use_angvel_cmd=true riceve rad/s,
      false riceve forza 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>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Modello di spinta: fluid_density è in kg/m^3, propeller_diameter in metri;
      thrust_coefficient lega velocità angolare e spinta. use_angvel_cmd=true riceve rad/s,
      false riceve forza 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>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Collegamento ad ArduPilot: endpoint di rete, sincronizzazione lock-step,
      trasformazioni dei riferimenti e nome dell'IMU. Mantieni questi collegamenti quando
      modifichi i parametri fisici.
    -->
    <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>
      <!--
        Associa un canale del controllore a un topic di comando del giunto. servo_min/max
        definiscono l'intervallo d'ingresso; offset e multiplier regolano scostamento e scala
        d'uscita. Mantieni l'associazione canale-topic.
      -->
      <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>
      <!--
        Associa un canale del controllore a un topic di comando del giunto. servo_min/max
        definiscono l'intervallo d'ingresso; offset e multiplier regolano scostamento e scala
        d'uscita. Mantieni l'associazione canale-topic.
      -->
      <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>
      <!--
        Associa un canale del controllore a un topic di comando del giunto. servo_min/max
        definiscono l'intervallo d'ingresso; offset e multiplier regolano scostamento e scala
        d'uscita. Mantieni l'associazione canale-topic.
      -->
      <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>
      <!--
        Associa un canale del controllore a un topic di comando del giunto. servo_min/max
        definiscono l'intervallo d'ingresso; offset e multiplier regolano scostamento e scala
        d'uscita. Mantieni l'associazione canale-topic.
      -->
      <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>
      <!--
        Associa un canale del controllore a un topic di comando del giunto. servo_min/max
        definiscono l'intervallo d'ingresso; offset e multiplier regolano scostamento e scala
        d'uscita. Mantieni l'associazione canale-topic.
      -->
      <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>
      <!--
        Associa un canale del controllore a un topic di comando del giunto. servo_min/max
        definiscono l'intervallo d'ingresso; offset e multiplier regolano scostamento e scala
        d'uscita. Mantieni l'associazione canale-topic.
      -->
      <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>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Pubblica odometria simulata con i riferimenti e la frequenza in Hz indicati. Descrive
      lo stato del simulatore; le misure simulate provengono dai topic dei sensori.
    -->
    <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>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <plugin filename="gz-sim-joint-state-publisher-system" name="gz::sim::systems::JointStatePublisher">
    </plugin>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <plugin filename="gz-sim-imu-system" name="gz::sim::systems::Imu">
    </plugin>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <plugin filename="gz-waves1-hydrodynamics-system" name="gz::sim::systems::Hydrodynamics">
      <enable>bluerov2::base_link</enable>
      <!--
        Coefficienti delle forze idrodinamiche. damping_on, viscous_drag_on e pressure_drag_on
        attivano i rispettivi termini. cDampL/R regolano lo smorzamento lineare/angolare; i
        coefficienti di pressione sono specifici di questo modello.
      -->
      <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>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="gnss_link">
      <!--
        Posa: x y z in metri, poi roll pitch yaw in radianti. Il riferimento è quello del
        genitore, salvo diversa indicazione in relative_to.
      -->
      <pose relative_to="base_link">0 0 0.3 0 0 0</pose>
      <!--
        Proprietà di massa: mass è in kg; pose definisce posizione e orientamento del
        riferimento del centro di massa rispetto al link. Usa misure o valori ricavati dal
        CAD.
      -->
      <inertial>
        <mass>.001</mass>
        <!--
          Tensore d'inerzia al centro di massa, in kg*m^2. ixx/iyy/izz sono i termini diagonali;
          ixy/ixz/iyz quelli misti. Il tensore deve essere coerente con massa e forma.
        -->
        <inertia>
          <ixx>0.000001</ixx>
          <iyy>0.000001</iyy>
          <izz>0.000001</izz>
        </inertia>
      </inertial>
      <!--
        Sensore fissato a questo link. pose definisce il montaggio e type seleziona la misura.
        L'editor prepara anche i topic e i sistemi necessari nel mondo.
      -->
      <sensor name="gnss" type="custom" gz:type="posim_gnss">
        <always_on>true</always_on>
        <!--
          Frequenza di aggiornamento richiesta, in Hz. Quella effettiva dipende anche dalla
          velocità della simulazione e dal carico grafico.
        -->
        <update_rate>5</update_rate>
        <!--
          Topic di uscita di Gazebo Transport. Deve corrispondere al manifest dei sensori e alle
          rotte del bridge ROS esportati.
        -->
        <topic>/model/bluerov2/gnss</topic>
      </sensor>
    </link>
    <!--
      Giunto tra i link parent e child. fixed blocca il moto relativo; revolute consente la
      rotazione attorno ad axis/xyz. Mantieni i nomi usati da propulsori e controllori.
    -->
    <joint name="gnss_joint" type="fixed">
      <parent>base_link</parent>
      <child>gnss_link</child>
    </joint>
    <!--
      Plugin del motore. filename identifica una libreria installata e name la sua
      implementazione. Mantieni entrambi quando carichi modifiche numeriche; il file SDF non
      installa plugin.
    -->
    <!--
      Modello del ricevitore GNSS. update_rate è in Hz; latency e reacquire_seconds in
      secondi. Rumore di posizione e dry_margin sono in metri; velocity_stddev in m/s.
      link_name, topic e wave_topic collegano antenna, uscita e superficie dell'acqua.
    -->
    <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>
