diff --git a/Core/Inc/yunhorn_sts_prd_conf.h b/Core/Inc/yunhorn_sts_prd_conf.h
index a3cfcd1..aed4972 100644
--- a/Core/Inc/yunhorn_sts_prd_conf.h
+++ b/Core/Inc/yunhorn_sts_prd_conf.h
@@ -105,8 +105,8 @@
 
 
 #define MajorVer									24U
-#define MinorVer									03U
-#define SubMinorVer 								07U
+#define MinorVer									4U
+#define SubMinorVer 								10U
 #define FirmwareVersion								3U
 #define	YUNHORN_STS_MAX_NVM_CFG_SIZE				64U
 #define YUNHORN_STS_AC_CODE_SIZE					20U
diff --git a/Core/Src/gpio.c b/Core/Src/gpio.c
index a955999..7e60793 100644
--- a/Core/Src/gpio.c
+++ b/Core/Src/gpio.c
@@ -57,8 +57,7 @@ void MX_GPIO_Init(void)
   HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
   HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
   HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-  //__HAL_RCC_GPIOA_CLK_DISABLE();
-  //__HAL_RCC_GPIOB_CLK_DISABLE();
+
   __HAL_RCC_GPIOC_CLK_DISABLE();
 
   /*Configure GPIO pin Output Level */
@@ -109,7 +108,7 @@ void MX_GPIO_Init(void)
   GPIO_InitStruct.Pull = GPIO_PULLUP;
   HAL_GPIO_Init(BUT1_GPIO_Port, &GPIO_InitStruct);
 #endif
-  __HAL_RCC_GPIOB_CLK_ENABLE();
+
   /*Configure GPIO pins : TOF_C_INT_Pin */
 #if defined(TOF_1)
   GPIO_InitStruct.Pin = TOF_C_INT_Pin;
@@ -194,6 +193,9 @@ HAL_GPIO_Init(SOAP_SWITCH_GPIO_Port, &GPIO_InitStruct);
 /* ==============   SOAP LEVEL DETECTION ========================= */
 #endif
 
+__HAL_RCC_GPIOA_CLK_DISABLE();
+__HAL_RCC_GPIOB_CLK_DISABLE();
+
 #if 0
   /* EXTI interrupt init*/
   HAL_NVIC_SetPriority(EXTI0_IRQn, 0, 0);
diff --git a/Core/Src/i2c.c b/Core/Src/i2c.c
index 89074ee..5237598 100644
--- a/Core/Src/i2c.c
+++ b/Core/Src/i2c.c
@@ -88,8 +88,8 @@ void HAL_I2C_MspInit(I2C_HandleTypeDef* i2cHandle)
 
   /** Initializes the peripherals clocks
     */
-	      PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_I2C2;
-	      PeriphClkInitStruct.I2c2ClockSelection = RCC_I2C2CLKSOURCE_PCLK1;
+   PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_I2C2;
+   PeriphClkInitStruct.I2c2ClockSelection = RCC_I2C2CLKSOURCE_PCLK1;
 	      if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct) != HAL_OK)
 	      {
 	        Error_Handler();
diff --git a/Core/Src/stm32_lpm_if.c b/Core/Src/stm32_lpm_if.c
index f7afe27..6cfb922 100644
--- a/Core/Src/stm32_lpm_if.c
+++ b/Core/Src/stm32_lpm_if.c
@@ -80,55 +80,26 @@ const struct UTIL_LPM_Driver_s UTIL_PowerDriver =
 
 void PWR_EnterOffMode(void)
 {
-#if 0
-	//HAL_GPIO_WritePin(GPIOB, GPIO_PIN_2, GPIO_PIN_RESET); /* LED OFF */
-	  HAL_SuspendTick();
-	  HAL_UART_DeInit(&huart2);
-	  //LL_PWR_ClearFlag_WU();
-	  //__HAL_PWR_CLEAR_FLAG(PWR_FLAG_SB);
-	  __HAL_PWR_CLEAR_FLAG(PWR_FLAG_WU);
-	  __HAL_PWR_CLEAR_FLAG(PWR_FLAG_LPMODES);
-	  //LL_PWR_ClearFlag_WU();
-	  HAL_PWR_EnterSTANDBYMode();
-#endif
+
 	  POWER_OFF;
-		//HAL_UART_DeInit(&huart2);
-		//vcom_DeInit();
+
 		HAL_GPIO_DeInit(GPIOA,GPIO_PIN_All);
 		HAL_GPIO_DeInit(GPIOB,GPIO_PIN_All);
 		HAL_GPIO_DeInit(GPIOC,GPIO_PIN_All);
 	  HAL_SuspendTick();
 	  HAL_PWR_EnterSTANDBYMode();
-#if 0
-	LED_OFF;
-	HAL_UART_DeInit(&huart2);
-  HAL_PWR_DisableWakeUpPin(PWR_WAKEUP_PIN1);//禁用所有使用的唤醒源:PWR_WAKEUP_PIN1 connected to PA.00
-  __HAL_PWR_CLEAR_FLAG(PWR_FLAG_WU);//清除所有相关的唤醒标志
-  HAL_PWR_EnableWakeUpPin(PWR_WAKEUP_PIN1);//启用连接到PA.00的WakeUp Pin
-  HAL_PWR_EnterSTANDBYMode();//进入待机模式
 
-  /* USER CODE BEGIN EnterOffMode_1 */
-	HAL_PWR_EnterSTANDBYMode();
-  /* USER CODE END EnterOffMode_1 */
-#endif
 }
 
 void PWR_ExitOffMode(void)
 {
   /* USER CODE BEGIN ExitOffMode_1 */
 #if 1
-	POWER_ON;
+
 	HAL_ResumeTick();
-	  //__HAL_PWR_CLEAR_FLAG(PWR_FLAG_SB);
-	//HAL_GPIO_WritePin(GPIOB, GPIO_PIN_2, GPIO_PIN_SET); /* LED ON */
 	return;
 #endif
 
-#if 0
-    __HAL_PWR_CLEAR_FLAG(PWR_FLAG_SB);
-    LED_ON;
-    HAL_Delay(200);
-#endif
   /* USER CODE END ExitOffMode_1 */
 }
 
@@ -163,7 +134,6 @@ void PWR_ExitStopMode(void)
   /* Resume sysTick : work around for debugger problem in dual core */
 
   HAL_ResumeTick();
-  POWER_ON;
   /*Not retained periph:
     ADC interface
     DAC interface USARTx, TIMx, i2Cx, SPIx
diff --git a/Core/Src/usart.c b/Core/Src/usart.c
index 1c8bcf9..2f44737 100644
--- a/Core/Src/usart.c
+++ b/Core/Src/usart.c
@@ -28,9 +28,7 @@
 
 UART_HandleTypeDef huart2;
 DMA_HandleTypeDef hdma_usart2_tx;
-#if 0
-DMA_HandleTypeDef hdma_usart2_rx;
-#endif
+
 /* USART2 init function */
 
 void MX_USART2_UART_Init(void)
@@ -62,12 +60,7 @@ void MX_USART2_UART_Init(void)
   {
     Error_Handler();
   }
-#if 0
-  if (HAL_UARTEx_SetRxFifoThreshold(&huart2, UART_RXFIFO_THRESHOLD_1_8) != HAL_OK)
-  {
-    Error_Handler();
-  }
-#endif
+
   if (HAL_UARTEx_EnableFifoMode(&huart2) != HAL_OK)
   {
     Error_Handler();
diff --git a/TOF/App/X-WL55_WLE5_53L0X.c b/TOF/App/X-WL55_WLE5_53L0X.c
index 9d9260c..12b332b 100644
--- a/TOF/App/X-WL55_WLE5_53L0X.c
+++ b/TOF/App/X-WL55_WLE5_53L0X.c
@@ -101,6 +101,7 @@ static void _I2cFailRecover(){
     }while(HAL_GPIO_ReadPin(I2C2_SDA_PORT, I2C2_SDA_PIN) == 0 && nRetry++<7);
 
     if( HAL_GPIO_ReadPin(I2C2_SDA_PORT, I2C2_SDA_PIN) == 0 ){
+#if 0
         __GPIOA_CLK_ENABLE();
         //We are still in bad i2c state warm user by blinking led but stay here
         GPIO_InitStruct.Pin = LED1_Pin ;
@@ -117,6 +118,7 @@ static void _I2cFailRecover(){
             HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_RESET);
             HAL_Delay(33*20);
         }while(1);
+#endif
     }
 }
 
diff --git a/TOF/App/X-WL55_WLE5_53L0X.h b/TOF/App/X-WL55_WLE5_53L0X.h
index 826ae63..0381a61 100644
--- a/TOF/App/X-WL55_WLE5_53L0X.h
+++ b/TOF/App/X-WL55_WLE5_53L0X.h
@@ -136,6 +136,7 @@ extern void XNUCLEO53L1A1_USART2_UART_Init(void);
 #endif
 
 /* ############ FOR SHARED GPIO1 INTR TO MCU    ###### */
+#if 0
 #define VL53L0X_GPIO1_C_GPIO_PORT   GPIOA
 #define VL53L0X_GPIO1_C_CLK_ENABLE  __GPIOA_CLK_ENABLE
 #define VL53L0X_GPIO1_C_GPIO_PIN    GPIO_PIN_10
@@ -150,6 +151,22 @@ extern void XNUCLEO53L1A1_USART2_UART_Init(void);
 #define VL53L0X_GPIO1_R_CLK_ENABLE  __GPIOA_CLK_ENABLE
 #define VL53L0X_GPIO1_R_GPIO_PIN    GPIO_PIN_10
 #define VL53L0X_GPIO1_R_INTx        EXTI15_10_IRQn
+#endif
+#define VL53L0X_GPIO1_C_GPIO_PORT   GPIOB
+#define VL53L0X_GPIO1_C_CLK_ENABLE  __GPIOB_CLK_ENABLE
+#define VL53L0X_GPIO1_C_GPIO_PIN    GPIO_PIN_3
+#define VL53L0X_GPIO1_C_INTx        EXTI3_IRQn
+
+#define VL53L0X_GPIO1_L_GPIO_PORT   GPIOB
+#define VL53L0X_GPIO1_L_CLK_ENABLE  __GPIOB_CLK_ENABLE
+#define VL53L0X_GPIO1_L_GPIO_PIN    GPIO_PIN_3
+#define VL53L0X_GPIO1_L_INTx        EXTI3_IRQn
+
+#define VL53L0X_GPIO1_R_GPIO_PORT   GPIOB
+#define VL53L0X_GPIO1_R_CLK_ENABLE  __GPIOB_CLK_ENABLE
+#define VL53L0X_GPIO1_R_GPIO_PIN    GPIO_PIN_3
+#define VL53L0X_GPIO1_R_INTx        EXTI3_IRQn
+
 /* ############ FOR SHARED GPIO1 INTR TO MCU    ###### */
 
 /** @} */ /* defgroup L53L1A1_GPIO1_MAP */