From 950c4e56f8829ad66d7b05f8bbb34580ba192872 Mon Sep 17 00:00:00 2001
From: Matteo Pignataro <matteo.pignataro@skywarder.eu>
Date: Fri, 16 Sep 2022 15:30:11 +0200
Subject: [PATCH] [Payload] Fixed pitot

---
 src/boards/Payload/Configs/RadioConfig.h | 2 +-
 src/boards/Payload/Sensors/Sensors.cpp   | 3 +++
 2 files changed, 4 insertions(+), 1 deletion(-)

diff --git a/src/boards/Payload/Configs/RadioConfig.h b/src/boards/Payload/Configs/RadioConfig.h
index 0d8ac9027..343b52c8f 100644
--- a/src/boards/Payload/Configs/RadioConfig.h
+++ b/src/boards/Payload/Configs/RadioConfig.h
@@ -34,7 +34,7 @@ namespace RadioConfig
 
 // Mavlink driver template parameters
 constexpr uint32_t RADIO_PKT_LENGTH     = 255;
-constexpr uint32_t RADIO_OUT_QUEUE_SIZE = 10;
+constexpr uint32_t RADIO_OUT_QUEUE_SIZE = 20;
 constexpr uint32_t RADIO_MAV_MSG_LENGTH = MAVLINK_MAX_DIALECT_PAYLOAD_SIZE;
 
 // Mavlink driver parameters
diff --git a/src/boards/Payload/Sensors/Sensors.cpp b/src/boards/Payload/Sensors/Sensors.cpp
index 0c22eed9d..b4b24d5e8 100644
--- a/src/boards/Payload/Sensors/Sensors.cpp
+++ b/src/boards/Payload/Sensors/Sensors.cpp
@@ -26,6 +26,7 @@
 #include <Payload/Buses.h>
 #include <Payload/Configs/SensorsConfig.h>
 #include <Payload/FlightStatsRecorder/FlightStatsRecorder.h>
+#include <common/ReferenceConfig.h>
 #include <common/events/Events.h>
 #include <drivers/interrupt/external_interrupts.h>
 #include <drivers/usart/USART.h>
@@ -34,6 +35,7 @@
 using namespace std;
 using namespace Boardcore;
 using namespace Common;
+using namespace ReferenceConfig;
 using namespace Payload::SensorsConfig;
 
 // BMX160 Watermark interrupt
@@ -471,6 +473,7 @@ void Sensors::pitotInit()
         [&]() { return ms5803->getLastSample().pressure; });
 
     pitot = new Pitot(getPitotPressure, getStaticPressure);
+    pitot->setReferenceValues(defaultReferenceValues);
 
     SensorInfo info(
         "PITOT", SAMPLE_PERIOD_ADS1118 * 4,
-- 
GitLab