diff --git a/src/boards/Payload/Configs/RadioConfig.h b/src/boards/Payload/Configs/RadioConfig.h
index 0d8ac90274c0fe531c2924faa9c16c25c13a062d..343b52c8f54838e6fcd0f012b8c24de7c03b40bc 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 0c22eed9d729aa618ae0d49d9f6d1e49e0ffb4d7..b4b24d5e8989f079e5af62304ff9e39d5d4068cc 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,