diff --git a/STM32CubeIDE/Release/WLE5CC_NODE_STS.bin b/STM32CubeIDE/Release/WLE5CC_NODE_STS.bin
index 4fc5f01..fe143b9 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 9fb6fbb..5435274 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 108ceaa..f423da0 100644
--- a/STS/TOF/App/app_tof.c
+++ b/STS/TOF/App/app_tof.c
@@ -243,7 +243,7 @@ void STS_LMZ_Ambient_Height_Scan_Process(void)
 					fhmos_bg.maskoff[i] = 1;
 				}
 				//sts_mask_bitmap[(uint8_t)(i/8)] |= (fhmos_bg.maskoff[i])<<(7-i%8);
-				sts_mask_bitmap[(uint8_t)(i/8)] |= (fhmos_bg.maskoff[i])<<(i%8);
+				sts_mask_bitmap[(uint8_t)(i/8)] |= (fhmos_bg.maskoff[i])<<(7-i%8);	// 2025-JAN-03 update
 				// if (i%8==0) APP_LOG(TS_OFF, VLEVEL_M, "\r\n");
 				APP_LOG(TS_OFF, VLEVEL_L, "|%3d  ", fhmos_bg.h2cm[i]*2);
 
@@ -254,6 +254,8 @@ void STS_LMZ_Ambient_Height_Scan_Process(void)
 				}
 
 		}
+	APP_LOG(TS_OFF, VLEVEL_L, "\r\n Thresholds: Headlevel=%4d cm, Gesture Mask off=%d cm, Min body height=%d cm\r\n",
+			(uint8_t)fhmos_cfg.th_head_level_height_cm, (uint8_t)fhmos_cfg.th_gesture_mask_off_height_cm, (uint8_t)(fhmos_cfg.th_fall_body_min_height_cm));
 
 	APP_LOG(TS_OFF, VLEVEL_L, "\r\n\n ------- Mask off matrix \r\n");
 
@@ -301,7 +303,7 @@ void sts_generate_fall_gesture_map(void)
 				fhmos_gesture.h2cm[i] 		=  (uint8_t)abs(sts_sensor_install_height - range_distance)/20;
 				//fhmos_gesture.maskoff[i]	= ((2*fhmos_gesture.h2cm[i])< fhmos_cfg.th_gesture_mask_off_height_cm)? 0:1;
 				fhmos_gesture.maskoff[i]	= (fhmos_gesture.h2cm[i]==0)? 0:1;
-				fhmos_gesture_bitmap[(uint8_t)(i/8)] |= (fhmos_gesture.maskoff[i])<<(i%8);
+				fhmos_gesture_bitmap[(uint8_t)(i/8)] |= (fhmos_gesture.maskoff[i])<<(7 - i%8);	// 2025-JAN-03 UPDATE
 				// debug
 //				if (i%8==0) printf("\r\n");
 //				printf("|%4ld %4d ", range_distance, fhmos_gesture.h2cm[i]);