diff --git a/LoRaWAN/App/lora_app.c b/LoRaWAN/App/lora_app.c
index 00d11a4..ebbc4b6 100644
--- a/LoRaWAN/App/lora_app.c
+++ b/LoRaWAN/App/lora_app.c
@@ -916,11 +916,14 @@ static void SendTxData(void)
     AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_1_distance_mm >>8 & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_1_distance_mm  & 0xFF);
 #elif	defined(STS_R1D)
-    AppData.Buffer[i++]	= 4;
+    AppData.Buffer[i++]	= 6;
     AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_1_distance_mm >>8 & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_1_distance_mm  & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_2_distance_mm >>8 & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_2_distance_mm  & 0xFF);
+    AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_3_distance_mm >>8 & 0xFF);
+    AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_3_distance_mm  & 0xFF);
+
 #elif	defined(STS_R5_EXT)
     AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_3_distance_mm >>8 & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_rr_sensor_data.tof_3_distance_mm  & 0xFF);
diff --git a/STM32CubeIDE/Release/WLE5CC_NODE_STS.bin b/STM32CubeIDE/Release/WLE5CC_NODE_STS.bin
index 347c625..d6e2921 100644
Binary files a/STM32CubeIDE/Release/WLE5CC_NODE_STS.bin and b/STM32CubeIDE/Release/WLE5CC_NODE_STS.bin differ
diff --git a/STM32CubeIDE/Release/WLE5CC_NODE_STS.elf b/STM32CubeIDE/Release/WLE5CC_NODE_STS.elf
index 88f7f48..f08f9a2 100644
Binary files a/STM32CubeIDE/Release/WLE5CC_NODE_STS.elf and b/STM32CubeIDE/Release/WLE5CC_NODE_STS.elf differ