diff --git a/LoRaWAN/App/lora_app.c b/LoRaWAN/App/lora_app.c
index 696844f..c5f57d7 100644
--- a/LoRaWAN/App/lora_app.c
+++ b/LoRaWAN/App/lora_app.c
@@ -856,16 +856,16 @@ static void SendTxData(void)
 #elif defined(STS_O5)
     	AppData.Buffer[i++] = (uint8_t)(oo_data.state_sensor1_on_off)&0xff;
 
-#elif  defined(YUNHORN_STS_R0_ENABLED)
-    	AppData.Buffer[i++] = (uint8_t)(0x06)&0xff;										//#length of following bytes
+#elif  defined(YUNHORN_STS_R0_ENABLED)													// TOF_1 & TOF_2 for STS_R1D
+    	AppData.Buffer[i++] = (uint8_t)(0x04)&0xff;										//#length of following bytes
     	AppData.Buffer[i++] = (uint8_t)(r0_data.distance_mm >>8)&0xff;					//#05
     	AppData.Buffer[i++] = (uint8_t)(r0_data.distance_mm)&0xff;						//#06
     	AppData.Buffer[i++] = (uint8_t)(r0_data.distance1_mm >>8)&0xff;					//#07
     	AppData.Buffer[i++] = (uint8_t)(r0_data.distance1_mm)&0xff;						//#08
-
+#ifdef TOF_3
     	AppData.Buffer[i++] = (uint8_t)(r0_data.distance2_mm >>8)&0xff;					//#09
     	AppData.Buffer[i++] = (uint8_t)(r0_data.distance2_mm)&0xff;						//#10
-
+#endif
 #ifdef SOAP_LEVEL
     	AppData.Buffer[i++] = (uint8_t)(sts_soap_level_state)&0xff;							//#11
 #endif