Add AHRS to Tethys equipped model

Combining upstream IMU and magnetometer sensors Signed-off-by: Michel Hidalgo <michel@ekumenlabs.com>
osrf · Feb 8, 2022 · a6f36cd · a6f36cd
1 parent e1749b5
commit a6f36cd
Showing 1 changed file with 28 additions and 0 deletions.
diff --git a/lrauv_description/models/tethys_equipped/model.sdf b/lrauv_description/models/tethys_equipped/model.sdf
@@ -76,6 +76,34 @@
             </noise>
           </ignition:current>
         </sensor>
+        <sensor
+            element_id="base_link"
+            action="add"
+            name="ahrs_imu"
+            type="imu">
+          <always_on>1</always_on>
+          <update_rate>10</update_rate>
+          <pose degrees="true">0 0 0 180 0 0</pose>
+          <orientation_reference_frame>
+            <localization>NED</localization>
+          </orientation_reference_frame>
+          <enable_orientation>1</enable_orientation>
+          <topic>/model/tethys/ahrs/imu</topic>
+          <plugin filename="ignition-gazebo-imu-system"
+                  name="ignition::gazebo::systems::Imu"/>
+        </sensor>
+        <sensor
+            element_id="base_link"
+            action="add"
+            name="ahrs_magnetometer"
+            type="magnetometer">
+          <always_on>1</always_on>
+          <update_rate>10</update_rate>
+          <pose degrees="true">0 0 0 180 0 0</pose>
+          <topic>/model/tethys/ahrs/magnetometer</topic>
+          <plugin filename="ignition-gazebo-magnetometer-system"
+                  name="ignition::gazebo::systems::Magnetometer"/>
+        </sensor>
       </experimental:params>
       <!-- Joint controllers -->
       <plugin