diff --git a/LoRaWAN/App/lora_app.c b/LoRaWAN/App/lora_app.c
index 6b10a6a..59db3e7 100644
--- a/LoRaWAN/App/lora_app.c
+++ b/LoRaWAN/App/lora_app.c
@@ -1405,6 +1405,7 @@ static void OnJoinRequest(LmHandlerJoinParams_t *joinParams)
       LmHandlerParams.IsTxConfirmed = true;
       LmHandlerErrorStatus_t status = LmHandlerSend(&AppData, LmHandlerParams.IsTxConfirmed, false);
       if (status ==LORAMAC_HANDLER_SUCCESS )  LmHandlerParams.IsTxConfirmed = false;
+      STS_SENSOR_Distance_Test_Process();
     }
     else
     {
diff --git a/STM32CubeIDE/Release/WLE5CC_NODE_STS.bin b/STM32CubeIDE/Release/WLE5CC_NODE_STS.bin
index 2efa0d0..d27ac64 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 652d54a..1605676 100644
Binary files a/STM32CubeIDE/Release/WLE5CC_NODE_STS.elf and b/STM32CubeIDE/Release/WLE5CC_NODE_STS.elf differ
diff --git a/STS/TOF/App/app_tof.c b/STS/TOF/App/app_tof.c
index 1162737..2bb5b3a 100644
--- a/STS/TOF/App/app_tof.c
+++ b/STS/TOF/App/app_tof.c
@@ -182,8 +182,9 @@ void STS_LMZ_Ambient_Height_Scan_Process(void)
 {
 
 #if 1
-	uint8_t i=0;
+	uint8_t i=0, j=0;
 	uint32_t range_distance =0;
+	uint32_t bg_distance[64]={0x0};
 
 	for (i=0; i<64; i++)
 	{
@@ -198,8 +199,11 @@ void STS_LMZ_Ambient_Height_Scan_Process(void)
 //	printf("sts sensor install height = %4d \r\n", (int)sts_sensor_install_height);
 
 
-	sts_high_threshold = sts_sensor_install_height;
-	sts_low_threshold  = sts_sensor_install_height-1400;
+	//sts_high_threshold = sts_sensor_install_height;
+	//sts_low_threshold  = sts_sensor_install_height-1400;
+	sts_high_threshold = 5000;
+	sts_low_threshold  = 1000;
+
 	//APP_LOG(TS_OFF, VLEVEL_M, "\r\nReconfig ----> Threshold High=%d mm, Low=%d mm \r\n", sts_high_threshold, sts_low_threshold);
 
 	STS_TOF_L8_Reconfig();
@@ -211,7 +215,10 @@ void STS_LMZ_Ambient_Height_Scan_Process(void)
 	    printf("VL53L8A1_RANGING_SENSOR_Start failed\n");
 	    while (1);
 	  }
+	  uint8_t idx[64]={0};
 
+	for (j=0; j<10; j++)
+	{
 	  if (ToF_EventDetected != 0)
 	  {
 	  	      ToF_EventDetected = 0;
@@ -219,8 +226,28 @@ void STS_LMZ_Ambient_Height_Scan_Process(void)
 	  		  if (status != BSP_ERROR_NONE)
 	  		  {
 	  			  APP_LOG(TS_OFF, VLEVEL_M, "\r\n x \r\n");
+	  		  } else
+	  		  {
+	  			  for (i=0; i<64; i++)
+	  			  {
+	  				  if (i%8==0) APP_LOG(TS_OFF, VLEVEL_L, "\r\n[cm]|");
+
+	  				  if ((Result.ZoneResult[i].NumberOfTargets > 0))
+	  				  {
+
+	  					  bg_distance[i] += (uint32_t)Result.ZoneResult[i].Distance[0];
+	  					  idx[i] ++;
+	  					  APP_LOG(TS_OFF, VLEVEL_L, "|%3d  ", Result.ZoneResult[i].Distance[0]/10);
+	  				  } else APP_LOG(TS_OFF, VLEVEL_L, "|%3d  ", 0);
+	  			  }
 	  		  }
 	  }
+	  HAL_Delay(400);
+	}
+
+	for (i=0;i<64;i++)
+		bg_distance[i] /= idx[i];
+
 	//STS_TOF_L8_Process();
 
 
@@ -231,9 +258,10 @@ void STS_LMZ_Ambient_Height_Scan_Process(void)
 	{
 				  /* Print distance and status */
 			if (i%8==0) APP_LOG(TS_OFF, VLEVEL_L, "\r\n[cm]|");
-			if ((Result.ZoneResult[i].NumberOfTargets > 0))
+			// if ((Result.ZoneResult[i].NumberOfTargets > 0))
 			{
-				range_distance = (uint32_t)Result.ZoneResult[i].Distance[0];
+				// range_distance = (uint32_t)Result.ZoneResult[i].Distance[0];
+				range_distance = (uint32_t)bg_distance[i];
 
 				fhmos_bg.h2cm[i] =  abs(sts_sensor_install_height - range_distance)/20;	// in 2 cm
 
@@ -251,10 +279,11 @@ void STS_LMZ_Ambient_Height_Scan_Process(void)
 				APP_LOG(TS_OFF, VLEVEL_L, "|%3d  ", fhmos_bg.h2cm[i]*2);
 
 			}
-			else {
-					fhmos_bg.h2cm[i] = 0;
-					APP_LOG(TS_OFF, VLEVEL_L, "|%3d  ", fhmos_bg.h2cm[i]);
-				}
+
+			//else {
+				//	fhmos_bg.h2cm[i] = 0;
+					//APP_LOG(TS_OFF, VLEVEL_L, "|%3d  ", fhmos_bg.h2cm[i]);
+				//}
 
 		}
 	APP_LOG(TS_OFF, VLEVEL_L, "\r\n Thresholds: Headlevel=%4d cm, Gesture Mask off=%d cm, Min body height=%d cm\r\n",