<?xml version='1.0' encoding='utf-8'?>
<sdf xmlns:gz="http://gazebosim.org" version="1.7">
  <!--
    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="wamv">
    <!--
      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",
          "dvl",
          "lidar_2d"
        ],
        "settings": {
          "camera": {
            "height": 480,
            "horizontal_fov": 1.4,
            "pose": [
              1.5,
              0.0,
              0.8,
              0.0,
              0.0,
              0.0
            ],
            "update_rate": 5,
            "width": 640
          },
          "camera_down": {
            "height": 600,
            "horizontal_fov": 1.4,
            "pose": [
              0.0,
              0.0,
              -0.5,
              0.0,
              1.5707963267948966,
              0.0
            ],
            "update_rate": 5,
            "width": 800
          },
          "dvl": {
            "pose": [
              0.0,
              0.0,
              -0.5,
              0.0,
              0.0,
              0.0
            ],
            "range_max": 20,
            "update_rate": 1
          },
          "lidar_2d": {
            "pose": [
              0.0,
              0.0,
              2.5,
              0.0,
              0.0,
              0.0
            ],
            "range_max": 50,
            "update_rate": 5
          }
        },
        "vehicle": "wamv"
      }
    -->
    <enable_wind>true</enable_wind>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="base_link">
      <!--
        Superficie visibile nel rendering e nelle camere. Le modifiche non aggiornano
        automaticamente la forma di collisione o la massa.
      -->
      <visual name="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/04f3ad2d4ac28cde0632b52f0ffaf7bb5f09da574a1a0b1402122ff2e1f2fbea.dae</uri>
          </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="collision">
        <geometry>
          <!--
            Risorsa mesh e scala facoltativa per asse. Conserva il percorso esportato insieme ai
            file; scale moltiplica le coordinate della mesh.
          -->
          <mesh>
            <uri>assets/31b5b6c712bf5c02a523be90f933526bf7a53b6abd84e2e279d8daabec043807.stl</uri>
          </mesh>
        </geometry>
      </collision>
      <!--
        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 0</pose>
        <mass>180</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>120</ixx>
          <ixy>0</ixy>
          <iyy>393</iyy>
          <iyz>0</iyz>
          <izz>446</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="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>1.5 0.0 0.8 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.0 0.0 -0.5 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_dvl" type="custom" gz:type="dvl">
        <!--
          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.5 0.0 0.0 0.0</pose>
        <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>1</update_rate>
        <!--
          Topic di uscita di Gazebo Transport. Deve corrispondere al manifest dei sensori e alle
          rotte del bridge ROS esportati.
        -->
        <topic>/vehicle/sensors/dvl</topic>
        <!--
          Geometria dei fasci DVL e inseguimento del fondo. arrangement specifica l'unità
          angolare; portata e risoluzione sono in metri. Il mondo richiede
          DopplerVelocityLogSystem; l'adattatore ROS pubblica velocità e stato.
        -->
        <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>
              <!--
                Rumore di misura. Nel modello gaussiano, mean e stddev usano le unità della grandezza
                misurata; stddev controlla la dispersione casuale.
              -->
              <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>
      <!--
        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_lidar_2d" 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/lidar_2d</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>360</samples>
              <resolution>1</resolution>
              <min_angle>-3.141592653589793</min_angle>
              <max_angle>3.141592653589793</max_angle>
            </horizontal>
          </scan>
          <range>
            <min>0.1</min>
            <max>50</max>
            <resolution>0.01</resolution>
          </range>
        </lidar>
        <!--
          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 2.5 0.0 0.0 0.0</pose>
        <frame_id>vehicle/lidar_2d</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>1.5 0.0 0.8 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.0 0.0 -0.5 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.0 0.0 -0.5 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>1.5 0.0 -0.5 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.5 0.0 0.0 0.0</pose>
          <always_on>true</always_on>
          <update_rate>1</update_rate>
          <topic>/vehicle/sensors/dvl</topic>
          <gz:dvl>
            <type>phased_array</type>
            <arrangement degrees="true">
              <beam id="1">
                <aperture>2</aperture>
                <rotation>45</rotation>
                <tilt>30</tilt>
              </beam>
              <beam id="2">
                <aperture>2</aperture>
                <rotation>135</rotation>
                <tilt>30</tilt>
              </beam>
              <beam id="3">
                <aperture>2</aperture>
                <rotation>-45</rotation>
                <tilt>30</tilt>
              </beam>
              <beam id="4">
                <aperture>2</aperture>
                <rotation>-135</rotation>
                <tilt>30</tilt>
              </beam>
            </arrangement>
            <tracking>
              <bottom_mode>
                <when>best</when>
                <noise type="gaussian">
                  <stddev>0.002</stddev>
                </noise>
                <visualize>false</visualize>
              </bottom_mode>
            </tracking>
            <resolution>0.01</resolution>
            <maximum_range>20</maximum_range>
            <minimum_range>0.1</minimum_range>
            <reference_frame>0 0 0 0 0 0</reference_frame>
          </gz:dvl>
          <frame_id>vehicle/dvl</frame_id>
        </sensor>
      -->
      <!--
        Sensore facoltativo lidar_2d: 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/lidar_2d
        frame_id: vehicle/lidar_2d
        ROS: /vehicle/sensors/lidar_2d (sensor_msgs/msg/LaserScan)

        <sensor name="payload_lidar_2d" type="gpu_lidar">
          <always_on>true</always_on>
          <update_rate>5</update_rate>
          <topic>/vehicle/sensors/lidar_2d</topic>
          <lidar>
            <scan>
              <horizontal>
                <samples>360</samples>
                <resolution>1</resolution>
                <min_angle>-3.141592653589793</min_angle>
                <max_angle>3.141592653589793</max_angle>
              </horizontal>
            </scan>
            <range>
              <min>0.1</min>
              <max>50</max>
              <resolution>0.01</resolution>
            </range>
          </lidar>
          <pose>0.0 0.0 2.5 0.0 0.0 0.0</pose>
          <frame_id>vehicle/lidar_2d</frame_id>
        </sensor>
      -->
    </link>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="left_engine_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>-2.373776 1.027135 0.318237 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="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/4fc1c298164ee6bb48d06e66af95a8eec7a63ffaf822b4226750043b316d4e2e.dae</uri>
          </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="engine_vertical_axis_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.16 0 -0.215 0 0 0</pose>
        <geometry>
          <box>
            <size>0.2 0.1 0.83</size>
          </box>
        </geometry>
      </collision>
      <!--
        Geometria di contatto usata dalla fisica. Dimensioni e posizione devono corrispondere
        allo scafo; una forma semplice riduce il costo delle collisioni.
      -->
      <collision name="engine_rear_end_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.34 0 0.12 0 0 0</pose>
        <geometry>
          <box>
            <size>0.12 0.15 0.12</size>
          </box>
        </geometry>
      </collision>
      <!--
        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>15</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.88924</ixx>
          <ixy>0</ixy>
          <iyy>0.911125</iyy>
          <iyz>0</iyz>
          <izz>0.078125</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="left_engine_joint" type="fixed">
      <parent>base_link</parent>
      <child>left_engine_link</child>
    </joint>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="right_engine_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>-2.373776 -1.027135 0.318237 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="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/4fc1c298164ee6bb48d06e66af95a8eec7a63ffaf822b4226750043b316d4e2e.dae</uri>
          </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="engine_vertical_axis_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.16 0 -0.215 0 0 0</pose>
        <geometry>
          <box>
            <size>0.2 0.1 0.83</size>
          </box>
        </geometry>
      </collision>
      <!--
        Geometria di contatto usata dalla fisica. Dimensioni e posizione devono corrispondere
        allo scafo; una forma semplice riduce il costo delle collisioni.
      -->
      <collision name="engine_rear_end_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.34 0 0.12 0 0 0</pose>
        <geometry>
          <box>
            <size>0.12 0.15 0.12</size>
          </box>
        </geometry>
      </collision>
      <!--
        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>15</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.88924</ixx>
          <ixy>0</ixy>
          <iyy>0.911125</iyy>
          <iyz>0</iyz>
          <izz>0.078125</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="right_engine_joint" type="fixed">
      <parent>base_link</parent>
      <child>right_engine_link</child>
    </joint>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="left_propeller_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="left_propeller_joint">0 0 0 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="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/2c891453932798e772dab9792855c0ff84fc0315a662eb1c872f8e16bb692c25.dae</uri>
          </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="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.11 0 0 0 1.570796 0</pose>
        <geometry>
          <cylinder>
            <length>0.08</length>
            <radius>0.24</radius>
          </cylinder>
        </geometry>
      </collision>
      <!--
        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.5</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.008545</ixx>
          <ixy>0</ixy>
          <iyy>0.008545</iyy>
          <iyz>0</iyz>
          <izz>0.0144</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="left_propeller_joint" type="revolute">
      <!--
        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="left_engine_link">-0.278156 0 -0.509371 0 0 0</pose>
      <parent>left_engine_link</parent>
      <child>left_propeller_link</child>
      <axis>
        <xyz>1 0 0</xyz>
        <dynamics>
          <damping>0.01</damping>
        </dynamics>
        <limit>
          <lower>-1e+16</lower>
          <upper>1e+16</upper>
        </limit>
      </axis>
    </joint>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="right_propeller_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="right_propeller_joint">0 0 0 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="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/2c891453932798e772dab9792855c0ff84fc0315a662eb1c872f8e16bb692c25.dae</uri>
          </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="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.11 0 0 0 1.570796 0</pose>
        <geometry>
          <cylinder>
            <length>0.08</length>
            <radius>0.24</radius>
          </cylinder>
        </geometry>
      </collision>
      <!--
        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.5</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.008545</ixx>
          <ixy>0</ixy>
          <iyy>0.008545</iyy>
          <iyz>0</iyz>
          <izz>0.0144</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="right_propeller_joint" type="revolute">
      <!--
        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="right_engine_link">-0.278156 0 -0.509371 0 0 0</pose>
      <parent>right_engine_link</parent>
      <child>right_propeller_link</child>
      <axis>
        <xyz>1 0 0</xyz>
        <dynamics>
          <damping>0.01</damping>
        </dynamics>
        <limit>
          <lower>-1e+16</lower>
          <upper>1e+16</upper>
        </limit>
      </axis>
    </joint>
    <!--
      Corpo rigido e sistema di riferimento locale. Geometria, proprietà di massa e sensori
      del link si muovono insieme.
    -->
    <link name="imu_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 0</pose>
        <mass>0.15</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.00001</ixx>
          <ixy>0</ixy>
          <ixz>0</ixz>
          <iyy>0.00002</iyy>
          <iyz>0</iyz>
          <izz>0.00002</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="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.141593 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>200</update_rate>
      </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="imu_joint" type="fixed">
      <child>imu_link</child>
      <parent>base_link</parent>
    </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>wamv</namespace>
      <joint_name>left_propeller_joint</joint_name>
      <use_angvel_cmd>0</use_angvel_cmd>
      <fluid_density>1000</fluid_density>
      <propeller_diameter>0.48</propeller_diameter>
      <thrust_coefficient>0.01</thrust_coefficient>
      <velocity_control>1</velocity_control>
      <max_thrust_cmd>2000.0</max_thrust_cmd>
      <min_thrust_cmd>-2000.0</min_thrust_cmd>
    </plugin>
    <!--
      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>wamv</namespace>
      <joint_name>right_propeller_joint</joint_name>
      <use_angvel_cmd>0</use_angvel_cmd>
      <fluid_density>1000</fluid_density>
      <propeller_diameter>0.48</propeller_diameter>
      <thrust_coefficient>0.01</thrust_coefficient>
      <velocity_control>1</velocity_control>
      <max_thrust_cmd>2000.0</max_thrust_cmd>
      <min_thrust_cmd>-2000.0</min_thrust_cmd>
    </plugin>
    <!--
      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="/opt/wwos/competition_hydrodynamics/lib/libwwos-competition-hydrodynamics.so" name="gz::sim::systems::CompetitionHydrodynamics">
      <enable>wamv::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>1</viscous_drag_on>
        <pressure_drag_on>1</pressure_drag_on>
        <cDampL1>1.0E-6</cDampL1>
        <cDampL2>1.0E-6</cDampL2>
        <cDampR1>1.0E-6</cDampR1>
        <cDampR2>1.0E-6</cDampR2>
        <cPDrag1>1.0E+2</cPDrag1>
        <cPDrag2>1.0E+2</cPDrag2>
        <fPDrag>0.4</fPDrag>
        <cSDrag1>1.0E+2</cSDrag1>
        <cSDrag2>1.0E+2</cSDrag2>
        <fSDrag>0.4</fSDrag>
        <vRDrag>1.0</vRDrag>
      </hydrodynamics>
      <current_user_configurable>true</current_user_configurable>
      <current_session_tag>0</current_session_tag>
      <current_start_enabled>false</current_start_enabled>
    </plugin>
    <!--
      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.14159265359 0 0</modelXYZToAirplaneXForwardZDown>
      <gazeboXYZToNED>0 0 0 3.14159265359 0 1.57079632679</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>left_propeller_joint</jointName>
        <servo_min>1000</servo_min>
        <servo_max>2000</servo_max>
        <type>COMMAND</type>
        <cmd_topic>/model/wamv/joint/left_propeller_joint/cmd_thrust</cmd_topic>
        <offset>-.5</offset>
        <multiplier>500</multiplier>
      </control>
      <!--
        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>right_propeller_joint</jointName>
        <servo_min>1000</servo_min>
        <servo_max>2000</servo_max>
        <type>COMMAND</type>
        <cmd_topic>/model/wamv/joint/right_propeller_joint/cmd_thrust</cmd_topic>
        <offset>-.5</offset>
        <multiplier>500</multiplier>
      </control>
    </plugin>
    <!--
      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">
      <dimensions>3</dimensions>
      <odom_frame>map</odom_frame>
      <robot_base_frame>base_link</robot_base_frame>
      <odom_publish_frequency>20</odom_publish_frequency>
      <odom_topic>/model/wamv/odometry</odom_topic>
    </plugin>
    <!--
      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 1.8 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/wamv/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/wamv/gnss</topic>
      <wave_topic>/wwos/wave_surface</wave_topic>
    </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-pose-publisher-system" name="gz::sim::systems::PosePublisher">
      <publish_model_pose>true</publish_model_pose>
      <publish_link_pose>true</publish_link_pose>
      <publish_sensor_pose>true</publish_sensor_pose>
      <publish_nested_model_pose>true</publish_nested_model_pose>
      <publish_visual_pose>false</publish_visual_pose>
      <publish_collision_pose>false</publish_collision_pose>
      <use_pose_vector_msg>true</use_pose_vector_msg>
      <update_frequency>20</update_frequency>
      <topic>/model/wamv/wwos/poses</topic>
    </plugin>
  </model>
</sdf>
