/* USER CODE BEGIN Header */
/**
  ******************************************************************************
  * @file    lora_app.c
  * @author  MCD Application Team
  * @brief   Application of the LRWAN Middleware
  ******************************************************************************
  * @attention
  *
  * Copyright (c) 2021 STMicroelectronics.
  * All rights reserved.
  *
  * This software is licensed under terms that can be found in the LICENSE file
  * in the root directory of this software component.
  * If no LICENSE file comes with this software, it is provided AS-IS.
  *
  ******************************************************************************
  */
/* USER CODE END Header */

/* Includes ------------------------------------------------------------------*/
#include "platform.h"
#include "sys_app.h"
#include "lora_app.h"
#include "stm32_seq.h"
#include "stm32_timer.h"
#include "utilities_def.h"
#include "app_version.h"
#include "lorawan_version.h"
#include "subghz_phy_version.h"
#include "lora_info.h"
#include "LmHandler.h"
#include "adc_if.h"
#include "CayenneLpp.h"
#include "sys_sensors.h"
#include "flash_if.h"
#include "stdio.h"
#include "timer_if.h"
#ifdef	CLOCK_SYNC
#include "LmhpClockSync.h"
#endif

/* USER CODE BEGIN Includes */
#include "app_tof_pin_conf.h"
#include "app_tof_peoplecount.h"
#include "yunhorn_sts_prd_conf.h"
#include "yunhorn_sts_sensors.h"

#if	(defined(STS_O6)||defined(STS_T6)||defined(O1L))
#include "sts_lamp_bar.h"
#endif

/* USER CODE END Includes */

/* External variables ---------------------------------------------------------*/
/* USER CODE BEGIN EV */
uint8_t outbuf[128]={0x0};
extern volatile uint8_t sts_ac_code[20];
extern volatile sts_cfg_nvm_t sts_cfg_nvm;
extern volatile uint8_t sts_work_mode, sts_cloud_netcolor, sts_lamp_bar_color, sts_status_color, luminance_level;
volatile static bool r_b=true;
extern volatile uint8_t sts_pir_read;
extern volatile uint32_t rfac_timer;
extern volatile uint32_t STS_TOFScanPeriod_msec, STS_TxPeriod_sec, STS_HeartBeatTimerPeriod_sec;
volatile uint8_t sts_data_buf[LORAWAN_APP_DATA_BUFFER_MAX_SIZE]={0x0};

extern volatile uint8_t fhmos_fall, fhmos_human_movement, fhmos_occupancy, fhmos_sos_alarm;
extern volatile uint32_t fhmos_fall_counter;
// extern volatile uint32_t sts_low_threshold, sts_high_threshold, sts_occupancy_threshold;
extern volatile sts_fhmos_sensor_data_t fhmos_data;
extern volatile sts_fhmos_sensor_config_t fhmos_cfg;
extern volatile sts_fhmos_sensor_ambient_height_t fhmos_bg;
// volatile LmHandlerAppData_t sts_app_data={ 0, 0, sts_data_buf };
extern volatile uint8_t sts_hall1_read, sts_hall2_read; // Above hall1_read == reed_hall_result, hall2_read == emergency_button
extern volatile uint8_t sts_hall3_read, sts_hall4_read;
//extern volatile uint8_t sts_pir_state, sts_pir_result;
extern volatile uint8_t last_sts_hall1_read, last_sts_hall2_read, last_sts_hall3_read, last_sts_hall4_read, last_sts_pir_read;
//volatile uint8_t sts_PIR_read = 0;
volatile bool locklow = false;
volatile uint32_t lowin=0;
volatile bool takelowTime;
uint32_t check_time=0;
volatile bool motionDetected =false;
uint32_t lastMotionTime =0;
const uint32_t ledOnDuration = 10000;


/* USER CODE END EV */

/* Private typedef -----------------------------------------------------------*/
/**
  * @brief LoRa State Machine states
  */
typedef enum TxEventType_e
{
  /**
    * @brief Appdata Transmission issue based on timer every TxDutyCycleTime
    */
  TX_ON_TIMER,
  /**
    * @brief Appdata Transmission external event plugged on OnSendEvent( )
    */
  TX_ON_EVENT
  /* USER CODE BEGIN TxEventType_t */

  /* USER CODE END TxEventType_t */
} TxEventType_t;

/* USER CODE BEGIN PTD */

/* USER CODE END PTD */

/* Private define ------------------------------------------------------------*/
/**
  * LEDs period value of the timer in ms
  */
#define LED_PERIOD_TIME 800

/**
  * Join switch period value of the timer in ms
  */
#define JOIN_TIME 2000

/*---------------------------------------------------------------------------*/
/*                             LoRaWAN NVM configuration                     */
/*---------------------------------------------------------------------------*/
/**
  * @brief LoRaWAN NVM Flash address
  * @note last 2 sector of a 128kBytes device
  */
#define LORAWAN_NVM_BASE_ADDRESS                    ((void *)0x0803F000UL)

/* USER CODE BEGIN PD */
static const char *slotStrings[] = { "1", "2", "C", "C_MC", "P", "P_MC" };
/* USER CODE END PD */

/* Private macro -------------------------------------------------------------*/
/* USER CODE BEGIN PM */

/* USER CODE END PM */

/* Private function prototypes -----------------------------------------------*/
/**
  * @brief  LoRa End Node send request
  */
static void SendTxData(void);

/**
  * @brief  TX timer callback function
  * @param  context ptr of timer context
  */
static void OnTxTimerEvent(void *context);

/**
  * @brief  join event callback function
  * @param  joinParams status of join
  */
static void OnJoinRequest(LmHandlerJoinParams_t *joinParams);

/**
  * @brief callback when LoRaWAN application has sent a frame
  * @brief  tx event callback function
  * @param  params status of last Tx
  */
static void OnTxData(LmHandlerTxParams_t *params);

/**
  * @brief callback when LoRaWAN application has received a frame
  * @param appData data received in the last Rx
  * @param params status of last Rx
  */
static void OnRxData(LmHandlerAppData_t *appData, LmHandlerRxParams_t *params);

/**
  * @brief callback when LoRaWAN Beacon status is updated
  * @param params status of Last Beacon
  */
static void OnBeaconStatusChange(LmHandlerBeaconParams_t *params);

/**
  * @brief callback when system time has been updated
  */
static void OnSysTimeUpdate(void);

/**
  * @brief callback when LoRaWAN application Class is changed
  * @param deviceClass new class
  */
static void OnClassChange(DeviceClass_t deviceClass);

/**
  * @brief  LoRa store context in Non Volatile Memory
  */
static void StoreContext(void);

/**
  * @brief  stop current LoRa execution to switch into non default Activation mode
  */
static void StopJoin(void);

/**
  * @brief  Join switch timer callback function
  * @param  context ptr of Join switch context
  */
static void OnStopJoinTimerEvent(void *context);

/**
  * @brief  Notifies the upper layer that the NVM context has changed
  * @param  state Indicates if we are storing (true) or restoring (false) the NVM context
  */
static void OnNvmDataChange(LmHandlerNvmContextStates_t state);

/**
  * @brief  Store the NVM Data context to the Flash
  * @param  nvm ptr on nvm structure
  * @param  nvm_size number of data bytes which were stored
  */
static void OnStoreContextRequest(void *nvm, uint32_t nvm_size);

/**
  * @brief  Restore the NVM Data context from the Flash
  * @param  nvm ptr on nvm structure
  * @param  nvm_size number of data bytes which were restored
  */
static void OnRestoreContextRequest(void *nvm, uint32_t nvm_size);

/**
  * Will be called each time a Radio IRQ is handled by the MAC layer
  *
  */
static void OnMacProcessNotify(void);

/**
  * @brief Change the periodicity of the uplink frames
  * @param periodicity uplink frames period in ms
  * @note Compliance test protocol callbacks
  */
static void OnTxPeriodicityChanged(uint32_t periodicity);

/**
  * @brief Change the confirmation control of the uplink frames
  * @param isTxConfirmed Indicates if the uplink requires an acknowledgement
  * @note Compliance test protocol callbacks
  */
static void OnTxFrameCtrlChanged(LmHandlerMsgTypes_t isTxConfirmed);

/**
  * @brief Change the periodicity of the ping slot frames
  * @param pingSlotPeriodicity ping slot frames period in ms
  * @note Compliance test protocol callbacks
  */
static void OnPingSlotPeriodicityChanged(uint8_t pingSlotPeriodicity);

/**
  * @brief Will be called to reset the system
  * @note Compliance test protocol callbacks
  */
static void OnSystemReset(void);

/* USER CODE BEGIN PFP */

/**
  * @brief  LED Tx timer callback function
  * @param  context ptr of LED context
  */
static void OnTxTimerLedEvent(void *context);

/**
  * @brief  LED Rx timer callback function
  * @param  context ptr of LED context
  */
static void OnRxTimerLedEvent(void *context);

/**
  * @brief  LED Join timer callback function
  * @param  context ptr of LED context
  */
static void OnJoinTimerLedEvent(void *context);

/**
  * @brief  STS Wake Up Scan timer callback function
  * @param  context ptr of VL53LX TOF People Counting Process context
  */
static void OnYunhornSTSWakeUpScanTimerEvent(void *context);


/**
  * @brief  STS Lamp Bar timer callback function
  * @param  context ptr of Lamp Bar LED context
  */
static void OnYunhornSTSLampBarColorTimerEvent(void *context);

/**
  * @brief  SYS occupancy, door lock, motion duration check timer callback function
  * @param  context ptr of duration check context
  */
static void OnYunhornSTSDurationCheckTimerEvent(void *context);

/**
  * @brief  Yunhorn STS Occupancy RSS WakeUP timer callback function
  * @param  context ptr of STS RSS WakeUp context
  */

static void OnYunhornSTSOORSSWakeUpTimerEvent(void *context);

/**
  * @brief  Yunhorn STS Heart beat timer callback function
  * @param  context ptr of context
  */

static void OnYunhornSTSHeartBeatTimerEvent(void *context);


/**
  * @brief  Yunhorn STS Heart Beat Periodicity Chagne function
  * @param  duration of periodicty in ms (1/1000 sec)
  */
//static void OnYunhornSTSHeartBeatPeriodicityChanged(uint32_t periodicity);




/* USER CODE END PFP */

/* Private variables ---------------------------------------------------------*/
/**
  * @brief LoRaWAN default activation type
  */
static ActivationType_t ActivationType = LORAWAN_DEFAULT_ACTIVATION_TYPE;

/**
  * @brief LoRaWAN force rejoin even if the NVM context is restored
  */
static bool ForceRejoin = LORAWAN_FORCE_REJOIN_AT_BOOT;

/**
  * @brief LoRaWAN handler Callbacks
  */
static LmHandlerCallbacks_t LmHandlerCallbacks =
{
  .GetBatteryLevel =              GetBatteryLevel,
  .GetTemperature =               GetTemperatureLevel,
  .GetUniqueId =                  GetUniqueId,
  .GetDevAddr =                   GetDevAddr,
  .OnRestoreContextRequest =      OnRestoreContextRequest,
  .OnStoreContextRequest =        OnStoreContextRequest,
  .OnMacProcess =                 OnMacProcessNotify,
  .OnNvmDataChange =              OnNvmDataChange,
  .OnJoinRequest =                OnJoinRequest,
  .OnTxData =                     OnTxData,
  .OnRxData =                     OnRxData,
  .OnBeaconStatusChange =         OnBeaconStatusChange,
  .OnSysTimeUpdate =              OnSysTimeUpdate,
  .OnClassChange =                OnClassChange,
  .OnTxPeriodicityChanged =       OnTxPeriodicityChanged,
  .OnTxFrameCtrlChanged =         OnTxFrameCtrlChanged,
  .OnPingSlotPeriodicityChanged = OnPingSlotPeriodicityChanged,
  .OnSystemReset =                OnSystemReset,
};

/**
  * @brief LoRaWAN handler parameters
  */
static LmHandlerParams_t LmHandlerParams =
{
  .ActiveRegion =             ACTIVE_REGION,
  .DefaultClass =             LORAWAN_DEFAULT_CLASS,
  .AdrEnable =                LORAWAN_ADR_STATE,
  .IsTxConfirmed =            LORAWAN_DEFAULT_CONFIRMED_MSG_STATE,
  .TxDatarate =               LORAWAN_DEFAULT_DATA_RATE,
  .TxPower =                  LORAWAN_DEFAULT_TX_POWER,
  .PingSlotPeriodicity =      LORAWAN_DEFAULT_PING_SLOT_PERIODICITY,
  .RxBCTimeout =              LORAWAN_DEFAULT_CLASS_B_C_RESP_TIMEOUT
};

/**
  * @brief Type of Event to generate application Tx
  */
static TxEventType_t EventType = TX_ON_TIMER;

/**
  * @brief Timer to handle the application Tx
  */
static UTIL_TIMER_Object_t TxTimer;

/**
  * @brief Timer to handle the application ToF Ranging Scan
  */
static UTIL_TIMER_Object_t YunhornSTSWakeUpScanTimer;

/**
  * @brief Timer to handle the application Heart beat timer
  */
static UTIL_TIMER_Object_t YunhornSTSHeartBeatTimer;

/**
  * @brief Timer to handle the application Lamp Bar LED Timer refresh
  */
//static UTIL_TIMER_Object_t YunhornSTSLampBarColorTimer;

static UTIL_TIMER_Object_t STSLampBarColorTimer;

/**
  * @brief Timer to handle the application Duration check Timer
  */
static UTIL_TIMER_Object_t STSDurationCheckTimer;

/**
  * @brief Tx Timer period
  */
//static UTIL_TIMER_Time_t TxPeriodicity = APP_TX_DUTYCYCLE;
UTIL_TIMER_Time_t TxPeriodicity = APP_TX_DUTYCYCLE;
/**
  * @brief Join Timer period
  */
static UTIL_TIMER_Object_t StopJoinTimer;

/* USER CODE BEGIN PV */
/**
  * @brief User application buffer
  */
static uint8_t AppDataBuffer[LORAWAN_APP_DATA_BUFFER_MAX_SIZE];

/**
  * @brief User application data structure
  */
static LmHandlerAppData_t AppData = { 0, 0, AppDataBuffer };

/**
  * @brief Specifies the state of the application LED
  */
static uint8_t AppLedStateOn = RESET;

/**
  * @brief Timer to handle the application Tx Led to toggle
  */
static UTIL_TIMER_Object_t TxLedTimer;

/**
  * @brief Timer to handle the application Rx Led to toggle
  */
static UTIL_TIMER_Object_t RxLedTimer;

/**
  * @brief Timer to handle the application Join Led to toggle
  */
static UTIL_TIMER_Object_t JoinLedTimer;

static volatile bool IsClockSynched = false;

/* USER CODE END PV */

/* Exported functions ---------------------------------------------------------*/
/* USER CODE BEGIN EF */
extern volatile uint8_t ToF_EventDetected;
/* USER CODE END EF */

void LoRaWAN_Init(void)
{
  /* USER CODE BEGIN LoRaWAN_Init_LV */
  uint32_t feature_version = 0UL;
  /* USER CODE END LoRaWAN_Init_LV */

  APP_LOG(TS_OFF, VLEVEL_M, "\n\r# YUNHORN SMARTOILETS: (%s) MTM:%d.%d HWFW:%d.%d V:%d.%d.%d #\n\r",(char*)YUNHORN_STS_PRD_STRING,
		  (uint8_t)sts_mtmcode1, (uint8_t)sts_mtmcode2,(uint8_t)sts_hardware_ver,(uint8_t)FirmwareVersion,
		  (uint8_t)MajorVer,(uint8_t)MinorVer,(uint8_t)SubMinorVer);
  /* USER CODE BEGIN LoRaWAN_Init_1 */

  /* Get LoRaWAN APP version*/
  APP_LOG(TS_OFF, VLEVEL_M, "APPLICATION_VERSION: V%X.%X.%X\r\n",
          (uint8_t)(APP_VERSION_MAIN),
          (uint8_t)(APP_VERSION_SUB1),
          (uint8_t)(APP_VERSION_SUB2));

  /* Get MW LoRaWAN info */
  APP_LOG(TS_OFF, VLEVEL_M, "MW_LORAWAN_VERSION:  V%X.%X.%X\r\n",
          (uint8_t)(LORAWAN_VERSION_MAIN),
          (uint8_t)(LORAWAN_VERSION_SUB1),
          (uint8_t)(LORAWAN_VERSION_SUB2));

  /* Get MW SubGhz_Phy info */
  APP_LOG(TS_OFF, VLEVEL_M, "MW_RADIO_VERSION:    V%X.%X.%X\r\n",
          (uint8_t)(SUBGHZ_PHY_VERSION_MAIN),
          (uint8_t)(SUBGHZ_PHY_VERSION_SUB1),
          (uint8_t)(SUBGHZ_PHY_VERSION_SUB2));

  /* Get LoRaWAN Link Layer info */
  LmHandlerGetVersion(LORAMAC_HANDLER_L2_VERSION, &feature_version);
  APP_LOG(TS_OFF, VLEVEL_M, "L2_SPEC_VERSION:     V%X.%X.%X\r\n",
          (uint8_t)(feature_version >> 24),
          (uint8_t)(feature_version >> 16),
          (uint8_t)(feature_version >> 8));

  /* Get LoRaWAN Regional Parameters info */
  LmHandlerGetVersion(LORAMAC_HANDLER_REGION_VERSION, &feature_version);
  APP_LOG(TS_OFF, VLEVEL_M, "RP_SPEC_VERSION:     V%X-%X.%X.%X\r\n",
          (uint8_t)(feature_version >> 24),
          (uint8_t)(feature_version >> 16),
          (uint8_t)(feature_version >> 8),
          (uint8_t)(feature_version));

  UTIL_TIMER_Create(&TxLedTimer, LED_PERIOD_TIME, UTIL_TIMER_ONESHOT, OnTxTimerLedEvent, NULL);
  UTIL_TIMER_Create(&RxLedTimer, LED_PERIOD_TIME, UTIL_TIMER_ONESHOT, OnRxTimerLedEvent, NULL);
  UTIL_TIMER_Create(&JoinLedTimer, LED_PERIOD_TIME, UTIL_TIMER_PERIODIC, OnJoinTimerLedEvent, NULL);
  UTIL_TIMER_Create(&STSLampBarColorTimer, LED_PERIOD_TIME, UTIL_TIMER_ONESHOT, OnYunhornSTSLampBarColorTimerEvent, NULL);
  UTIL_TIMER_Create(&STSDurationCheckTimer, 10000, UTIL_TIMER_PERIODIC, OnYunhornSTSDurationCheckTimerEvent, NULL);

  if (FLASH_IF_Init(NULL) != FLASH_IF_OK)
  {
    Error_Handler();
  }

  /* USER CODE END LoRaWAN_Init_1 */

  UTIL_TIMER_Create(&StopJoinTimer, JOIN_TIME, UTIL_TIMER_ONESHOT, OnStopJoinTimerEvent, NULL);

  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_LmHandlerProcess), UTIL_SEQ_RFU, LmHandlerProcess);

  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_LoRaSendOnTxTimerOrButtonEvent), UTIL_SEQ_RFU, SendTxData);
  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_LoRaStoreContextEvent), UTIL_SEQ_RFU, StoreContext);
  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_LoRaStopJoinEvent), UTIL_SEQ_RFU, StopJoin);

  // TODO XXX  2024-06-04
#ifdef	CLOCK_SYNC
    LmHandlerPackageRegister( PACKAGE_ID_CLOCK_SYNC, NULL );
    IsClockSynched = false;
#endif

  /* Init Info table used by LmHandler*/
  LoraInfo_Init();

  /* Init the Lora Stack*/
  LmHandlerInit(&LmHandlerCallbacks, APP_VERSION);

  LmHandlerConfigure(&LmHandlerParams);

  /* USER CODE BEGIN LoRaWAN_Init_2 */
  UTIL_TIMER_Start(&JoinLedTimer);

  /* USER CODE END LoRaWAN_Init_2 */

  LmHandlerJoin(ActivationType, ForceRejoin);

    UTIL_TIMER_Create(&YunhornSTSHeartBeatTimer, 1000*STS_HeartBeatTimerPeriod_sec, UTIL_TIMER_ONESHOT, OnYunhornSTSHeartBeatTimerEvent, NULL);
    UTIL_TIMER_Start(&YunhornSTSHeartBeatTimer);

  if (EventType == TX_ON_TIMER)
  {

    /* send every time timer elapses */
    UTIL_TIMER_Create(&TxTimer, TxPeriodicity, UTIL_TIMER_ONESHOT, OnTxTimerEvent, NULL);
    UTIL_TIMER_Start(&TxTimer);
  }
  else
  {
    /* USER CODE BEGIN LoRaWAN_Init_3 */

    /* USER CODE END LoRaWAN_Init_3 */
  }

  /* USER CODE BEGIN LoRaWAN_Init_Last */

  STS_REBOOT_CONFIG_Init();

  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_YunhornSTSEventRFAC), UTIL_SEQ_RFU, STS_YunhornSTSEventRFAC_Process);

#ifdef STS_M1

  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_YunhornSTSEventP1), UTIL_SEQ_RFU, STS_YunhornSTSEventP1_Process);

#endif


#if	defined(STS_P2)||defined(STS_T6)||defined(L8)

  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_YunhornSTSEventP5), UTIL_SEQ_RFU, STS_YunhornSTSEventP5_Process);

#endif

#ifdef	STS_R4
  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_YunhornSTSEventP6), UTIL_SEQ_RFU, STS_YunhornSTSEventP6_Process);
#endif

#ifdef VL53L0
  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_YunhornSTSEventP4), UTIL_SEQ_RFU, STS_YunhornSTSEventP4_Process);
#endif

#if	defined(STS_T6)||defined(STS_O6)||defined(O1L)
  UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_YunhornSTSEventP3), UTIL_SEQ_RFU, STS_YunhornSTSEventP3_Process);
#endif

#if	defined(STS_P2)||defined(STS_T6)||defined(L8)
  UTIL_TIMER_Create(&YunhornSTSWakeUpScanTimer, STS_TOFScanPeriod_msec, UTIL_TIMER_PERIODIC, (void*)STS_YunhornSTSEventP5_Process, NULL);
  UTIL_TIMER_Start(&YunhornSTSWakeUpScanTimer);
#endif

  UTIL_TIMER_Start(&STSLampBarColorTimer);
  UTIL_TIMER_Start(&STSDurationCheckTimer);
  //UTIL_TIMER_Create(&YunhornSTSHeartBeatTimer, 1000*STS_HeartBeatTimerPeriod_sec, UTIL_TIMER_PERIODIC, OnYunhornSTSHeartBeatTimerEvent, NULL);
//  UTIL_TIMER_Create(&YunhornSTSHeartBeatTimer, 1000*STS_HeartBeatTimerPeriod_sec, UTIL_TIMER_ONESHOT, OnYunhornSTSHeartBeatTimerEvent, NULL);
//  UTIL_TIMER_Start(&YunhornSTSHeartBeatTimer);

  /* USER CODE END LoRaWAN_Init_Last */
}

/* USER CODE BEGIN PB_Callbacks */

void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin)
{

  switch (GPIO_Pin)
  {
    case  BUT1_Pin:
      /* Note: when "EventType == TX_ON_TIMER" this GPIO is not initialized */
	  	HAL_Delay(250);
	  	__HAL_GPIO_EXTI_CLEAR_IT(GPIO_Pin);
	  	//__HAL_GPIO_EXTI_CLEAR_IT(GPIO_Pin);
    	sts_hall1_read = HALL1_STATE;
    	if (last_sts_hall1_read != sts_hall1_read) // to eliminate power drop issue of PCB with long REEDSWITCH CABLES
    	{
// 1) record event start/stop time
    	  APP_LOG(TS_OFF, VLEVEL_M,"\r\n EXIT_CALLBACK,  Door state =%d \r\n", sts_hall1_read);
		  OnSensor1StateChanged();
// 2) change lamp bar color
    	if (sts_hall1_read == STS_Status_Door_Close)
    	{
    		sts_lamp_bar_color = STS_OCCUPY_COLOR;
    		sts_status_color = STS_OCCUPY_COLOR;
    		// APP_LOG(TS_OFF, VLEVEL_M,"\r\n EXIT_CALLBACK,  Door CLOSED: sts status color =%d, lampbar_color=%d \r\n", sts_status_color, sts_lamp_bar_color);
    	} else
    	{
    		//sts_lamp_bar_color = prev_color;
    		sts_status_color = STS_VACANT_COLOR;
    		sts_lamp_bar_color = STS_VACANT_COLOR;
    		// APP_LOG(TS_OFF, VLEVEL_M,"\r\n EXTI_CALLBACK,  Door Open: sts status color =%d, lampbar_color=%d \r\n", sts_status_color, sts_lamp_bar_color);
    	}
// 3) combine states and colors
		//STS_YunhornSTSEventP1_Process();
    	//STS_Combined_Status_Processing();

// 4) upload state change messages
      //if (EventType == TX_ON_EVENT)
#if 0
    	if (sts_hall1_read == STS_Status_Door_Close)
      {
    		fhmos_occupancy = 1;
      }
#endif
    	last_sts_hall1_read = sts_hall1_read;
      UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaSendOnTxTimerOrButtonEvent), CFG_SEQ_Prio_0);

    	} //else {
    		//APP_LOG(TS_OFF, VLEVEL_M, "\r\n --- ---- ----- -------- hall 1, door close again \r\n");
    	//}
      break;

#ifndef	STS_R4
#if 1
    case  BUT2_Pin:
    	HAL_Delay(100);
	  	  __HAL_GPIO_EXTI_CLEAR_IT(GPIO_Pin);
    	sts_hall2_read = HALL2_STATE;
    	//printf("\r\n HALL 2 state =%d \r\n", sts_hall2_read);
// 1) record event start/stop time
  	  OnSensor2StateChanged();
// 2) change lamp bar color

    	if (sts_hall2_read == STS_Status_SOS_Pushdown)
    	{
    		sts_lamp_bar_color = STS_SOS_COLOR;
    		sts_status_color = STS_SOS_COLOR;
    		fhmos_sos_alarm = 1;
    	}
    	else if (sts_hall2_read ==STS_Status_SOS_Release)
        {
    		sts_lamp_bar_color = STS_VACANT_COLOR;
    		sts_status_color = STS_VACANT_COLOR;
    		fhmos_sos_alarm = 0;
        }
    	 last_sts_hall2_read = sts_hall2_read;
 // 3) combine states and colors

   	   //STS_YunhornSTSEventP1_Process();

// 4) upload state change messages
#if 0
   	if (sts_hall2_read == STS_Status_SOS_Release)
     {
   		fhmos_sos_alarm = 0;

     }
#endif
     UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaSendOnTxTimerOrButtonEvent), CFG_SEQ_Prio_0);
 	  last_sts_hall2_read = sts_hall2_read;

      break;
#endif
#endif
#if 0
    case  BUT3_Pin:
      UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaStoreContextEvent), CFG_SEQ_Prio_0);
      break;
#endif
#if 1
    case PIR_Pin:
    	sts_pir_read = PIR_STATE;
    	__HAL_GPIO_EXTI_CLEAR_IT(GPIO_Pin);
    	OnSensorPIR1StateChanged();
#endif
    	  //OnSensor3StateChanged();
    	  //OnSensorPIR1StateChanged();
    	  //STS_YunhornSTSEventP1_Process();
    	  //UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaSendOnTxTimerOrButtonEvent), CFG_SEQ_Prio_0);
    	  //last_sts_hall3_read = sts_hall3_read;
#if 0
    	HAL_Delay(100);
	  	  __HAL_GPIO_EXTI_CLEAR_IT(GPIO_Pin);

    	sts_pir_state = PIR_STATE;
    	printf("\r\n PIR state =%d \r\n", sts_pir_state);
    	if (sts_pir_state == 1) {
    		fhmos_human_movement = 1;
    	} else {
    		fhmos_human_movement = 0;

    	}
#endif
    	if (sts_pir_read != last_sts_pir_read)
    	{
    		last_sts_pir_read = sts_hall3_read;
    		UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaSendOnTxTimerOrButtonEvent), CFG_SEQ_Prio_0);
    	}

    	break;
#if 0
    case  HALL4_Pin:
  	  sts_hall4_read = HALL4_STATE;
  	  HAL_Delay(30);	//de-bouncing
  	  if (sts_hall4_read == HALL4_STATE)
  	  {
  		  //APP_LOG(TS_OFF, VLEVEL_L, "\n\n ALARM RESET Button Read = %02x   --%s\r\n", sts_hall4_read, sts_sos_status_code[sts_hall4_read]);
  		  OnSensor4StateChanged();
  		  //sensor_data_ready =1;
  		  //UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP1), CFG_SEQ_Prio_0);
  		  {
  			  STS_YunhornSTSEventP1_Process();
  			  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaSendOnTxTimerOrButtonEvent), CFG_SEQ_Prio_0);

  		  }
  				  last_sts_hall4_read = sts_hall4_read;
  	  }
      break;
#endif
#if	(defined(VL53L0)||defined(VL53LX)||defined(L8))
    case TOF_INT_EXTI_PIN:
    	 ToF_EventDetected = 1;
    	 break;
#endif

    default:
      break;
  }
}

/* USER CODE END PB_Callbacks */

/* Private functions ---------------------------------------------------------*/
/* USER CODE BEGIN PrFD */

/* USER CODE END PrFD */

static void OnRxData(LmHandlerAppData_t *appData, LmHandlerRxParams_t *params)
{
  /* USER CODE BEGIN OnRxData_1 */
  uint8_t RxPort = 0;

  if (params != NULL)
  {
#ifndef	STM32WLE5xx
    HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_SET); /* LED_BLUE */
#endif
    UTIL_TIMER_Start(&RxLedTimer);

    if (params->IsMcpsIndication)
    {
      if (appData != NULL)
      {
        RxPort = appData->Port;
        if (appData->Buffer != NULL)
        {
          switch (appData->Port)
          {
            case LORAWAN_SWITCH_CLASS_PORT:
              /*this port switches the class*/
              if (appData->BufferSize == 1)
              {
                switch (appData->Buffer[0])
                {
                  case 0:
                  {
                    LmHandlerRequestClass(CLASS_A);
                    break;
                  }
                  case 1:
                  {
                    LmHandlerRequestClass(CLASS_B);
                    break;
                  }
                  case 2:
                  {
                    LmHandlerRequestClass(CLASS_C);
                    break;
                  }
                  default:
                    break;
                }
              }
              /*   switch class A/B/C  			*/
              DeviceClass_t deviceClass = CLASS_A;
              LmHandlerGetCurrentClass( &deviceClass );
              uint8_t	i=0;
              outbuf[i++] = (uint8_t) 'L';
              outbuf[i++] = (uint8_t) sts_mtmcode1;
              outbuf[i++] = (uint8_t) sts_mtmcode2;
              outbuf[i++] = (uint8_t) sts_version;
              outbuf[i++] = (uint8_t) (0x41+ deviceClass); //translate to 'A','B','C'
              STS_SENSOR_Upload_Message(YUNHORN_STS_USER_APP_CTRL_REPLY_PORT, i, (uint8_t *)outbuf);
              break;
            case LORAWAN_USER_APP_PORT:
              if (appData->BufferSize == 1)
              {
                AppLedStateOn = appData->Buffer[0] & 0x01;
                if (AppLedStateOn == RESET)
                {
                  APP_LOG(TS_OFF, VLEVEL_H, "LED OFF\r\n");
#ifndef	STM32WLE5xx
                  HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET); /* LED_RED */
#endif
                }
                else
                {
                  APP_LOG(TS_OFF, VLEVEL_H, "LED ON\r\n");
#ifndef	STM32WLE5xx
                  HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_SET); /* LED_RED */
#endif
                }
              }
              break;
			case YUNHORN_STS_USER_APP_CTRL_PORT:
			  if (appData->BufferSize != 1)
			  {
				if (appData->BufferSize < 128) {
					USER_APP_AUTO_RESPONDER_Parse((uint8_t*)appData->Buffer, appData->BufferSize);
				}
			  }
			break;

            default:

              break;
          }
        }
      }
    }
    if (params->RxSlot < RX_SLOT_NONE)
    {
      APP_LOG(TS_OFF, VLEVEL_H, "###### D/L FRAME:%04d | PORT:%d | DR:%d | SLOT:%s | RSSI:%d | SNR:%d\r\n",
              params->DownlinkCounter, RxPort, params->Datarate, slotStrings[params->RxSlot],
              params->Rssi, params->Snr);
    }
  }
  /* USER CODE END OnRxData_1 */
}
void STS_SENSOR_Upload_AppData_Message(LmHandlerAppData_t stsAppdata)
{
	uint32_t nextTxIn =0;
	LmHandlerErrorStatus_t status;

	if (LmHandlerIsBusy() == false)
	{

		status = LmHandlerSend(&stsAppdata, LmHandlerParams.IsTxConfirmed, false);
		if (LORAMAC_HANDLER_SUCCESS == status)
		{
			APP_LOG(TS_ON, VLEVEL_H, "SEND REQUEST\r\n");
		}
		else if (LORAMAC_HANDLER_DUTYCYCLE_RESTRICTED == status)
		{
			nextTxIn = LmHandlerGetDutyCycleWaitTime();
			if (nextTxIn > 0)
			{
				APP_LOG(TS_ON, VLEVEL_H, "Next Tx in  : ~%d second(s)\r\n", (nextTxIn / 1000));
			}
		}

	}

}

void STS_SENSOR_Upload_Message(uint8_t appDataPort, uint8_t appBufferSize, uint8_t *appDataBuffer)
{
	LmHandlerErrorStatus_t status = LORAMAC_HANDLER_ERROR;
	UTIL_TIMER_Time_t nextTxIn = 0;

	//if (LmHandlerIsBusy() == false)
	{

		for (uint8_t i=0;i<appBufferSize; i++) {
			AppData.Buffer[i] = appDataBuffer[i];
		}

		AppData.Port = appDataPort;
		AppData.BufferSize = appBufferSize;

		//APP_LOG(TS_OFF, VLEVEL_M, "\n\r AppPort=%d BufferSize=%d \r\n", AppData.Port,AppData.BufferSize);

		status = LmHandlerSend(&AppData, LmHandlerParams.IsTxConfirmed, false);
		if (LORAMAC_HANDLER_SUCCESS == status)
		{
			APP_LOG(TS_ON, VLEVEL_M, "SEND REQUEST\r\n");
		}
		else if (LORAMAC_HANDLER_DUTYCYCLE_RESTRICTED == status)
		{
			APP_LOG(TS_ON, VLEVEL_M, "DUTYCYCLE RESTRICTED\r\n");

			nextTxIn = LmHandlerGetDutyCycleWaitTime();
			if (nextTxIn > 0)
			{
				APP_LOG(TS_ON, VLEVEL_M, "Next Tx in  : ~%d second(s)\r\n", (nextTxIn / 1000));
			}
		}

	}

}

static void SendTxData(void)
{
  /* USER CODE BEGIN SendTxData_1 */
  LmHandlerErrorStatus_t status = LORAMAC_HANDLER_ERROR;
  uint8_t batteryLevel = GetBatteryLevel();
  sensor_t sensor_data;
  UTIL_TIMER_Time_t nextTxIn = 0;
#ifdef STS_P2
  sts_people_count_sensor_data_t sts_p2_sensor_data={0x0};
#elif	defined(STS_T6)
  sts_tof_presence_detection_sensor_data_t sts_t6_sensor_data={0x0};
#elif	defined(STS_R1)||defined(STS_R1D)||defined(STS_R2)||defined(STS_R5)
  sts_tof_range_data_t sts_rr_sensor_data={0x0,0x0,0x0};
#elif	defined(STS_R4)
  sts_r_sensor_data_t sts_r4_sensor_data={0};
#elif	defined(STS_M1)
  sts_r_sensor_data_t sts_m1_sensor_data={0};
#elif 	defined(STS_L8)
  sts_fhmos_sensor_data_t fhmos_data={0};
#elif 	defined(STS_XX)
#endif

  if (LmHandlerIsBusy() == false)
  {
#ifdef CAYENNE_LPP
    uint8_t channel = 0;
#else
    uint32_t i = 0;
#if 0
    uint16_t pressure = 0;
    int16_t temperature = 0;
    uint16_t humidity = 0;

    int32_t latitude = 0;
    int32_t longitude = 0;
    uint16_t altitudeGps = 0;
#endif
#endif /* CAYENNE_LPP */

    EnvSensors_Read(&sensor_data);

#ifdef 	STS_R4
    //UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP6), CFG_SEQ_Prio_0);
    //STS_YunhornSTSEventP6_Process();
    STS_R4_sensor_read(&sts_r4_sensor_data);
#endif

#ifdef 	STS_M1

    STS_M1_sensor_read(&sts_m1_sensor_data);
#endif

#ifdef	STS_L8
    STS_FHMOS_sensor_read(&fhmos_data);
#endif

#ifdef VL53LX
#ifdef STS_P2
    STS_people_count_sensor_Read(&sts_p2_sensor_data);
#elif defined(STS_T6)
    STS_tof_presence_detection_sensor_Read(&sts_t6_sensor_data);
#endif
#endif

#ifdef VL53L0
    STS_YunhornSTSEventP4_Process();
    STS_RR_Sensor_Read(&sts_rr_sensor_data);
    APP_LOG(TS_OFF, VLEVEL_M, "\r\n VL53L0 sensor data read \r\n");

#ifdef STS_R1
    AppData.Port = YUNHORN_STS_R1_LORA_APP_DATA_PORT; /* STS-R1 Data Port */
#elif defined(STS_R1D)
    AppData.Port = YUNHORN_STS_R1D_LORA_APP_DATA_PORT; /* STS-R1D Data Port */
#elif defined(STS_R2)
    AppData.Port = YUNHORN_STS_R2_LORA_APP_DATA_PORT; /* STS-R2 Data Port */
#elif defined(STS_R5)
    AppData.Port = YUNHORN_STS_R5_LORA_APP_DATA_PORT; /* STS-R5 Data Port */
#endif	//STS_R1

#endif	//VL53L0

#ifdef	STS_R4		//SOAP/SANITIZER LEVEL
    AppData.Port = YUNHORN_STS_R4_LORA_APP_DATA_PORT; /* STS-R4 Data Port */
#endif
#ifdef STS_M1		// WATER LEAKAGE SENSOR
    AppData.Port = YUNHORN_STS_M1_LORA_APP_DATA_PORT; /* STS-M1 Data Port */
#endif

    AppData.Buffer[i++]	= (uint8_t) (AppLedStateOn|0x80);		// for first byte, cannot be 0x0
    AppData.Buffer[i++]	= (uint8_t) sts_mtmcode1;
    AppData.Buffer[i++]	= (uint8_t) sts_mtmcode2;
    AppData.Buffer[i++]	= (uint8_t) sts_hardware_ver;
    AppData.Buffer[i++]	= (uint8_t) 99*batteryLevel/254;

#if 0
    APP_LOG(TS_ON, VLEVEL_M, "VDDA: %d\r\n", batteryLevel);
    APP_LOG(TS_ON, VLEVEL_M, "temp: %d\r\n", (int16_t)(sensor_data.temperature));

    //AppData.Port = LORAWAN_USER_APP_PORT;
#endif

#ifdef	STS_P2
    AppData.Port = YUNHORN_STS_P2_LORA_APP_DATA_PORT; /* STS-P2 Data Port */
#elif 	defined(STS_T6)
    AppData.Port = YUNHORN_STS_T6_LORA_APP_DATA_PORT; /* STS-T6 Data Port */
#elif 	defined(L8)
    AppData.Port = YUNHORN_STS_L8_LORA_APP_DATA_PORT; /* STS-L8 Data Port */

#endif

#ifdef CAYENNE_LPP
    CayenneLppReset();
    CayenneLppAddBarometricPressure(channel++, sensor_data.pressure);
    CayenneLppAddTemperature(channel++, sensor_data.temperature);
    CayenneLppAddRelativeHumidity(channel++, (uint16_t)(sensor_data.humidity));

    if ((LmHandlerParams.ActiveRegion != LORAMAC_REGION_US915) && (LmHandlerParams.ActiveRegion != LORAMAC_REGION_AU915)
        && (LmHandlerParams.ActiveRegion != LORAMAC_REGION_AS923))
    {
      CayenneLppAddDigitalInput(channel++, GetBatteryLevel());
      CayenneLppAddDigitalOutput(channel++, AppLedStateOn);
    }

    CayenneLppCopy(AppData.Buffer);
    AppData.BufferSize = CayenneLppGetSize();
#else  /* not CAYENNE_LPP */

#if 0
    humidity    = (uint16_t)(sensor_data.humidity * 10);            /* in %*10     */
    temperature = (int16_t)(sensor_data.temperature);
    pressure = (uint16_t)(sensor_data.pressure * 100 / 10); /* in hPa / 10 */

    AppData.Buffer[i++] = AppLedStateOn;
    AppData.Buffer[i++] = (uint8_t)((pressure >> 8) & 0xFF);
    AppData.Buffer[i++] = (uint8_t)(pressure & 0xFF);
    AppData.Buffer[i++] = (uint8_t)(temperature & 0xFF);
    AppData.Buffer[i++] = (uint8_t)((humidity >> 8) & 0xFF);
    AppData.Buffer[i++] = (uint8_t)(humidity & 0xFF);

    if ((LmHandlerParams.ActiveRegion == LORAMAC_REGION_US915) || (LmHandlerParams.ActiveRegion == LORAMAC_REGION_AU915)
        || (LmHandlerParams.ActiveRegion == LORAMAC_REGION_AS923))
    {
      AppData.Buffer[i++] = 0;
      AppData.Buffer[i++] = 0;
      AppData.Buffer[i++] = 0;
      AppData.Buffer[i++] = 0;
    }
    else
    {
      latitude = sensor_data.latitude;
      longitude = sensor_data.longitude;

      AppData.Buffer[i++] = GetBatteryLevel();        /* 1 (very low) to 254 (fully charged) */
      AppData.Buffer[i++] = (uint8_t)((latitude >> 16) & 0xFF);
      AppData.Buffer[i++] = (uint8_t)((latitude >> 8) & 0xFF);
      AppData.Buffer[i++] = (uint8_t)(latitude & 0xFF);
      AppData.Buffer[i++] = (uint8_t)((longitude >> 16) & 0xFF);
      AppData.Buffer[i++] = (uint8_t)((longitude >> 8) & 0xFF);
      AppData.Buffer[i++] = (uint8_t)(longitude & 0xFF);
      AppData.Buffer[i++] = (uint8_t)((altitudeGps >> 8) & 0xFF);
      AppData.Buffer[i++] = (uint8_t)(altitudeGps & 0xFF);
    }

#endif  //if 0

#endif /* CAYENNE_LPP */

#ifdef	VL53L0		//VL53L0

#if	(defined(STS_R1)||defined(STS_R5))
    AppData.Buffer[i++]	= 2;
    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++] = (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);
#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);
#endif

#endif			//VL53L0
#ifdef	STS_P2

#ifdef VL53LX	// VL53L1X
    AppData.Buffer[i++] = (uint8_t) 15;	//sum of below
     AppData.Buffer[i++] = (uint8_t)((sts_p2_sensor_data.Walk_In_People_Count>>8) & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_p2_sensor_data.Walk_In_People_Count & 0xFF);

     AppData.Buffer[i++] = (uint8_t)((sts_p2_sensor_data.Walk_Out_People_Count>>8) & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_p2_sensor_data.Walk_Out_People_Count & 0xFF);

     AppData.Buffer[i++] = (uint8_t)((sts_p2_sensor_data.Walk_Around_People_Count>>8) & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_p2_sensor_data.Walk_Around_People_Count & 0xFF);
#endif			// VL53L1X
#ifdef VL53LX	// VL53L1X
     AppData.Buffer[i++] = (uint8_t)((sts_p2_sensor_data.Count_Period) & 0xFF);
     AppData.Buffer[i++] = (uint8_t)((sts_p2_sensor_data.Count_Period_Unit) & 0xFF);

     AppData.Buffer[i++] = (uint8_t)((sts_p2_sensor_data.Sum_Day_Walk_In_People_Count>>8) & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_p2_sensor_data.Sum_Day_Walk_In_People_Count & 0xFF);

     AppData.Buffer[i++] = (uint8_t)((sts_p2_sensor_data.Sum_Day_Walk_Out_People_Count>>8) & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_p2_sensor_data.Sum_Day_Walk_Out_People_Count & 0xFF);

     AppData.Buffer[i++] = (uint8_t)((sts_p2_sensor_data.Sum_Day_Walk_Around_People_Count>>8) & 0xFF);
     AppData.Buffer[i++] = (uint8_t)(sts_p2_sensor_data.Sum_Day_Walk_Around_People_Count & 0xFF);

     AppData.Buffer[i++] = (uint8_t)(sts_p2_sensor_data.Count_Valid & 0xFF);
#endif		// VL53L1X

#endif	//STS_P2

#if	defined(STS_T6)
     AppData.Buffer[i++] = 1;
     AppData.Buffer[i++] = (uint8_t)((sts_t6_sensor_data.tof_range_presence_state & 0xFF));

#endif	//STS_T6

#if	defined(L8)
     //AppData.Buffer[i++] = 4;
#if 0
     if ((fhmos_data.state_fall ==3)||(fhmos_data.state_occupancy ==3)||(fhmos_data.state_human_movement ==3))
     {
    	 AppData.Buffer[i++] = 10;
    	 AppData.Buffer[i++] = 0x04;			// payload type, 0x01= regular payload
    	 AppData.Buffer[i++] = fhmos_data.state_fall;
    	 AppData.Buffer[i++] = fhmos_data.state_human_movement;
         AppData.Buffer[i++] = fhmos_data.state_occupancy;
         AppData.Buffer[i++] = fhmos_data.state_sos_alarm;
         AppData.Buffer[i++] = fhmos_data.lamp_bar_color;
         if (fhmos_data.state_fall ==3)
         {
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_fall_confirmed>>24);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_fall_confirmed>>16);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_fall_confirmed>>8);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_fall_confirmed);
         } else if (fhmos_data.state_occupancy ==3){
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_overstay_confirmed>>24);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_overstay_confirmed>>16);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_overstay_confirmed>>8);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_overstay_confirmed);

         } else if (fhmos_data.state_human_movement ==3)
         {
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_motionless_confirmed>>24);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_motionless_confirmed>>16);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_motionless_confirmed>>8);
        	 AppData.Buffer[i++] = 0xff&(fhmos_data.time_stamp_motionless_confirmed);
         }

     } else
#endif
     {

    	 AppData.Buffer[i++] = 9;
    	 AppData.Buffer[i++] = 0x01;
    	 AppData.Buffer[i++] = fhmos_data.state_fall;
  	     AppData.Buffer[i++] = fhmos_data.state_human_movement;
   	     AppData.Buffer[i++] = fhmos_data.state_occupancy;
   	     AppData.Buffer[i++] = fhmos_data.state_sos_alarm;

   	     AppData.Buffer[i++] = fhmos_data.lamp_bar_color;
   	     AppData.Buffer[i++] = fhmos_data.state_hall_1;
   	     AppData.Buffer[i++] = fhmos_data.state_hall_2;
   	     AppData.Buffer[i++] = fhmos_data.state_PIR;

   	     if (fhmos_data.state_fall_released == 1)
   	     {
   	    	fhmos_data.state_fall_released == 0;

   	    	AppData.Buffer[i++]	= (uint8_t) 0xff&(fhmos_data.time_stamp_fall_confirmed>>24);
   	    	AppData.Buffer[i++]	= (uint8_t) 0xff&(fhmos_data.time_stamp_fall_confirmed>>16);
   	    	AppData.Buffer[i++]	= (uint8_t) 0xff&(fhmos_data.time_stamp_fall_confirmed>>8);
   	    	AppData.Buffer[i++]	= (uint8_t) 0xff&(fhmos_data.time_stamp_fall_confirmed);

   	     }
     }
     //     AppData.Buffer[i++] = 0x01;			// payload type, 0x01= regular payload
#if 0
     AppData.Buffer[i++] = fhmos_data.state_fall;
     AppData.Buffer[i++] = fhmos_data.state_human_movement;
     AppData.Buffer[i++] = fhmos_data.state_occupancy;
     AppData.Buffer[i++] = fhmos_data.state_sos_alarm;

     AppData.Buffer[i++] = fhmos_data.lamp_bar_color;
     AppData.Buffer[i++] = fhmos_data.state_hall_1;
     AppData.Buffer[i++] = fhmos_data.state_hall_2;
     AppData.Buffer[i++] = fhmos_data.state_PIR;
#endif

#elif defined(L8)
 	sts_data->lamp_bar_color		= sts_lamp_bar_color;
 	sts_data->state_hall_1			= sts_hall1_read;
 	sts_data->state_hall_2			= sts_hall2_read;
 	sts_data->state_PIR				= sts_pir_read;;

     AppData.Buffer[i++] = 8;
     AppData.Buffer[i++] = fhmos_data.state_fall;
     AppData.Buffer[i++] = fhmos_data.state_human_movement;
     AppData.Buffer[i++] = fhmos_data.occupancy;
     AppData.Buffer[i++] = fhmos_data.state_sos_alarm;
     AppData.Buffer[i++] = fhmos_data.lamp_bar_color;
     AppData.Buffer[i++] = fhmos_data.batteryLevel;



     //(uint8_t)((sts_l8_sensor_data.tof_range_presence_state & 0xFF));

#endif	//STS_T6

/* STS-R4 SOAP LEVEL SENSOR */
#ifdef	STS_R4
     AppData.Buffer[i++]	= 2;
     AppData.Buffer[i++] 	= (uint8_t)(sts_r4_sensor_data.measure_tech & 0xFF);
     AppData.Buffer[i++] 	= (uint8_t)(sts_r4_sensor_data.on_off_event & 0xFF);
#endif	//STS_R4

/* STS-M1 WATER LEAKAGE SENSOR */
#ifdef	STS_M1
          AppData.Buffer[i++]	= 2;
          AppData.Buffer[i++] 	= (uint8_t)(sts_m1_sensor_data.measure_tech & 0xFF);
          AppData.Buffer[i++] 	= (uint8_t)(sts_m1_sensor_data.on_off_event & 0xFF);
#endif	//STS_M1

    AppData.BufferSize = i;

#ifdef 	CLOCK_SYNC
    if( IsClockSynched == false )
    {
        status = LmhpClockSyncAppTimeReq( );

        if (LORAMAC_HANDLER_SUCCESS == status) {
        	OnSysTimeUpdate();
        }
    }
#endif


    if ((JoinLedTimer.IsRunning) && (LmHandlerJoinStatus() == LORAMAC_HANDLER_SET))
    {
      UTIL_TIMER_Stop(&JoinLedTimer);
      HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET); /* LED_RED */
    }

    status = LmHandlerSend(&AppData, LmHandlerParams.IsTxConfirmed, false);
    if (LORAMAC_HANDLER_SUCCESS == status)
    {
      APP_LOG(TS_ON, VLEVEL_M, "SEND REQUEST\r\n");
    }
    else if (LORAMAC_HANDLER_DUTYCYCLE_RESTRICTED == status)
    {
      nextTxIn = LmHandlerGetDutyCycleWaitTime();
      if (nextTxIn > 0)
      {
        APP_LOG(TS_ON, VLEVEL_L, "Next Tx in  : ~%d second(s)\r\n", (nextTxIn / 1000));
      }
    }
  }

  if (EventType == TX_ON_TIMER)
  {
    UTIL_TIMER_Stop(&TxTimer);
    UTIL_TIMER_SetPeriod(&TxTimer, MAX(nextTxIn, TxPeriodicity));
    UTIL_TIMER_Start(&TxTimer);
  }

  /* USER CODE END SendTxData_1 */
}

static void OnTxTimerEvent(void *context)
{
  /* USER CODE BEGIN OnTxTimerEvent_1 */

  /* USER CODE END OnTxTimerEvent_1 */

#ifdef STS_R4
  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP6), CFG_SEQ_Prio_0);
#elif defined(STS_M1)
  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP1), CFG_SEQ_Prio_0);
#elif defined(STS_R1D)
  APP_LOG(TS_OFF, VLEVEL_M, "\nSET TASK  P4\r\n");
  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP4), CFG_SEQ_Prio_0);
#endif

  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaSendOnTxTimerOrButtonEvent), CFG_SEQ_Prio_0);

  /*Wait for next tx slot*/
  UTIL_TIMER_Start(&TxTimer);
  /* USER CODE BEGIN OnTxTimerEvent_2 */

  /* USER CODE END OnTxTimerEvent_2 */
}

/* USER CODE BEGIN PrFD_LedEvents */
static void OnTxTimerLedEvent(void *context)
{
  HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET); /* LED_GREEN */
}

static void OnRxTimerLedEvent(void *context)
{
  HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_RESET); /* LED_BLUE */
}

static void OnJoinTimerLedEvent(void *context)
{
  HAL_GPIO_TogglePin(LED3_GPIO_Port, LED3_Pin); /* LED_RED */
}

/* USER CODE END PrFD_LedEvents */

static void OnTxData(LmHandlerTxParams_t *params)
{
  /* USER CODE BEGIN OnTxData_1 */
  if ((params != NULL))
  {
    /* Process Tx event only if its a mcps response to prevent some internal events (mlme) */
    if (params->IsMcpsConfirm != 0)
    {
      HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_SET); /* LED_GREEN */
      UTIL_TIMER_Start(&TxLedTimer);

      APP_LOG(TS_OFF, VLEVEL_M, "\r\n###### ========== MCPS-Confirm =============\r\n");
      APP_LOG(TS_OFF, VLEVEL_H, "###### U/L FRAME:%04d | PORT:%d | DR:%d | PWR:%d", params->UplinkCounter,
              params->AppData.Port, params->Datarate, params->TxPower);

      APP_LOG(TS_OFF, VLEVEL_H, " | MSG TYPE:");
      if (params->MsgType == LORAMAC_HANDLER_CONFIRMED_MSG)
      {
        APP_LOG(TS_OFF, VLEVEL_H, "CONFIRMED [%s]\r\n", (params->AckReceived != 0) ? "ACK" : "NACK");
      }
      else
      {
        APP_LOG(TS_OFF, VLEVEL_H, "UNCONFIRMED\r\n");
      }
    }
  }
  /* USER CODE END OnTxData_1 */
}

static void OnJoinRequest(LmHandlerJoinParams_t *joinParams)
{
  /* USER CODE BEGIN OnJoinRequest_1 */
  if (joinParams != NULL)
  {
    if (joinParams->Status == LORAMAC_HANDLER_SUCCESS)
    {
      UTIL_TIMER_Stop(&JoinLedTimer);
      HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET); /* LED_RED */

      APP_LOG(TS_OFF, VLEVEL_M, "\r\n###### = JOINED = ");
      if (joinParams->Mode == ACTIVATION_TYPE_ABP)
      {
        APP_LOG(TS_OFF, VLEVEL_M, "ABP ======================\r\n");
      }
      else
      {
        APP_LOG(TS_OFF, VLEVEL_M, "OTAA =====================\r\n");
      }
      AppData.Port = 1;
      AppData.BufferSize = 16;
      // UTIL_MEM_cpy_8(AppData.Buffer, (uint8_t*)"YUNHORN168", 10);
      UTIL_MEM_cpy_8((uint8_t*)AppData.Buffer, (uint8_t *)YUNHORN_STS_PRD_STRING, sizeof(YUNHORN_STS_PRD_STRING));
      AppData.BufferSize = sizeof(YUNHORN_STS_PRD_STRING);
      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
    {
      APP_LOG(TS_OFF, VLEVEL_M, "\r\n###### = JOIN FAILED\r\n");
    }

    APP_LOG(TS_OFF, VLEVEL_H, "###### U/L FRAME:JOIN | DR:%d | PWR:%d\r\n", joinParams->Datarate, joinParams->TxPower);

  }
  // UTIL_TIMER_Start(&YunhornSTSWakeUpScanTimer);
  /* USER CODE END OnJoinRequest_1 */
}

static void OnBeaconStatusChange(LmHandlerBeaconParams_t *params)
{
  /* USER CODE BEGIN OnBeaconStatusChange_1 */
  if (params != NULL)
  {
    switch (params->State)
    {
      default:
      case LORAMAC_HANDLER_BEACON_LOST:
      {
        APP_LOG(TS_OFF, VLEVEL_M, "\r\n###### BEACON LOST\r\n");
        break;
      }
      case LORAMAC_HANDLER_BEACON_RX:
      {
        APP_LOG(TS_OFF, VLEVEL_M,
                "\r\n###### BEACON RECEIVED | DR:%d | RSSI:%d | SNR:%d | FQ:%d | TIME:%d | DESC:%d | "
                "INFO:02X%02X%02X %02X%02X%02X\r\n",
                params->Info.Datarate, params->Info.Rssi, params->Info.Snr, params->Info.Frequency,
                params->Info.Time.Seconds, params->Info.GwSpecific.InfoDesc,
                params->Info.GwSpecific.Info[0], params->Info.GwSpecific.Info[1],
                params->Info.GwSpecific.Info[2], params->Info.GwSpecific.Info[3],
                params->Info.GwSpecific.Info[4], params->Info.GwSpecific.Info[5]);
        break;
      }
      case LORAMAC_HANDLER_BEACON_NRX:
      {
        APP_LOG(TS_OFF, VLEVEL_M, "\r\n###### BEACON NOT RECEIVED\r\n");
        break;
      }
    }
  }
  /* USER CODE END OnBeaconStatusChange_1 */
}

static void OnSysTimeUpdate(void)
{
  /* USER CODE BEGIN OnSysTimeUpdate_1 */
	IsClockSynched = true;
  /* USER CODE END OnSysTimeUpdate_1 */
}

static void OnClassChange(DeviceClass_t deviceClass)
{
  /* USER CODE BEGIN OnClassChange_1 */
  APP_LOG(TS_OFF, VLEVEL_M, "Switch to Class %c done\r\n", "ABC"[deviceClass]);
  /* USER CODE END OnClassChange_1 */
}

static void OnMacProcessNotify(void)
{
  /* USER CODE BEGIN OnMacProcessNotify_1 */

  /* USER CODE END OnMacProcessNotify_1 */
  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LmHandlerProcess), CFG_SEQ_Prio_0);

  /* USER CODE BEGIN OnMacProcessNotify_2 */

  /* USER CODE END OnMacProcessNotify_2 */
}

void OnTxPeriodicityChanged(uint32_t periodicity)
{
  /* USER CODE BEGIN OnTxPeriodicityChanged_1 */

  /* USER CODE END OnTxPeriodicityChanged_1 */
  TxPeriodicity = periodicity;

  if (TxPeriodicity == 0)
  {
    /* Revert to application default periodicity */
    TxPeriodicity = APP_TX_DUTYCYCLE;
  }

  /* Update timer periodicity */
  UTIL_TIMER_Stop(&TxTimer);
  UTIL_TIMER_SetPeriod(&TxTimer, TxPeriodicity);
  UTIL_TIMER_Start(&TxTimer);
  /* USER CODE BEGIN OnTxPeriodicityChanged_2 */

  /* USER CODE END OnTxPeriodicityChanged_2 */
}

static void OnTxFrameCtrlChanged(LmHandlerMsgTypes_t isTxConfirmed)
{
  /* USER CODE BEGIN OnTxFrameCtrlChanged_1 */

  /* USER CODE END OnTxFrameCtrlChanged_1 */
  LmHandlerParams.IsTxConfirmed = isTxConfirmed;
  /* USER CODE BEGIN OnTxFrameCtrlChanged_2 */

  /* USER CODE END OnTxFrameCtrlChanged_2 */
}

static void OnPingSlotPeriodicityChanged(uint8_t pingSlotPeriodicity)
{
  /* USER CODE BEGIN OnPingSlotPeriodicityChanged_1 */

  /* USER CODE END OnPingSlotPeriodicityChanged_1 */
  LmHandlerParams.PingSlotPeriodicity = pingSlotPeriodicity;
  /* USER CODE BEGIN OnPingSlotPeriodicityChanged_2 */

  /* USER CODE END OnPingSlotPeriodicityChanged_2 */
}

static void OnSystemReset(void)
{
  /* USER CODE BEGIN OnSystemReset_1 */

  /* USER CODE END OnSystemReset_1 */
  if ((LORAMAC_HANDLER_SUCCESS == LmHandlerHalt()) && (LmHandlerJoinStatus() == LORAMAC_HANDLER_SET))
  {
    NVIC_SystemReset();
  }
  /* USER CODE BEGIN OnSystemReset_Last */

  /* USER CODE END OnSystemReset_Last */
}

static void StopJoin(void)
{
  /* USER CODE BEGIN StopJoin_1 */
  HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_SET); /* LED_BLUE */
  HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_SET); /* LED_GREEN */
  HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_SET); /* LED_RED */
  /* USER CODE END StopJoin_1 */

  UTIL_TIMER_Stop(&TxTimer);

  if (LORAMAC_HANDLER_SUCCESS != LmHandlerStop())
  {
    APP_LOG(TS_OFF, VLEVEL_M, "LmHandler Stop on going ...\r\n");
  }
  else
  {
    APP_LOG(TS_OFF, VLEVEL_M, "LmHandler Stopped\r\n");
    if (LORAWAN_DEFAULT_ACTIVATION_TYPE == ACTIVATION_TYPE_ABP)
    {
      ActivationType = ACTIVATION_TYPE_OTAA;
      APP_LOG(TS_OFF, VLEVEL_M, "LmHandler switch to OTAA mode\r\n");
    }
    else
    {
      ActivationType = ACTIVATION_TYPE_ABP;
      APP_LOG(TS_OFF, VLEVEL_M, "LmHandler switch to ABP mode\r\n");
    }
    LmHandlerConfigure(&LmHandlerParams);
    LmHandlerJoin(ActivationType, true);
    UTIL_TIMER_Start(&TxTimer);
  }
  UTIL_TIMER_Start(&StopJoinTimer);
  /* USER CODE BEGIN StopJoin_Last */

  /* USER CODE END StopJoin_Last */
}

static void OnStopJoinTimerEvent(void *context)
{
  /* USER CODE BEGIN OnStopJoinTimerEvent_1 */

  /* USER CODE END OnStopJoinTimerEvent_1 */
  if (ActivationType == LORAWAN_DEFAULT_ACTIVATION_TYPE)
  {
    UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaStopJoinEvent), CFG_SEQ_Prio_0);
  }
  /* USER CODE BEGIN OnStopJoinTimerEvent_Last */
  HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_RESET); /* LED_BLUE */
  HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET); /* LED_GREEN */
  HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET); /* LED_RED */
  /* USER CODE END OnStopJoinTimerEvent_Last */
}

static void StoreContext(void)
{
  LmHandlerErrorStatus_t status = LORAMAC_HANDLER_ERROR;

  /* USER CODE BEGIN StoreContext_1 */

  /* USER CODE END StoreContext_1 */
  status = LmHandlerNvmDataStore();

  if (status == LORAMAC_HANDLER_NVM_DATA_UP_TO_DATE)
  {
    APP_LOG(TS_OFF, VLEVEL_M, "NVM DATA UP TO DATE\r\n");
  }
  else if (status == LORAMAC_HANDLER_ERROR)
  {
    APP_LOG(TS_OFF, VLEVEL_M, "NVM DATA STORE FAILED\r\n");
  }
  /* USER CODE BEGIN StoreContext_Last */

  /* USER CODE END StoreContext_Last */
}

static void OnNvmDataChange(LmHandlerNvmContextStates_t state)
{
  /* USER CODE BEGIN OnNvmDataChange_1 */

  /* USER CODE END OnNvmDataChange_1 */
  if (state == LORAMAC_HANDLER_NVM_STORE)
  {
    APP_LOG(TS_OFF, VLEVEL_M, "NVM DATA STORED\r\n");
  }
  else
  {
    APP_LOG(TS_OFF, VLEVEL_M, "NVM DATA RESTORED\r\n");
  }
  /* USER CODE BEGIN OnNvmDataChange_Last */

  /* USER CODE END OnNvmDataChange_Last */
}

static void OnStoreContextRequest(void *nvm, uint32_t nvm_size)
{
  /* USER CODE BEGIN OnStoreContextRequest_1 */

  /* USER CODE END OnStoreContextRequest_1 */
  /* store nvm in flash */
  if (FLASH_IF_Erase(LORAWAN_NVM_BASE_ADDRESS, FLASH_PAGE_SIZE) == FLASH_IF_OK)
  {
    FLASH_IF_Write(LORAWAN_NVM_BASE_ADDRESS, (const void *)nvm, nvm_size);
  }
  /* USER CODE BEGIN OnStoreContextRequest_Last */

  /* USER CODE END OnStoreContextRequest_Last */
}

static void OnRestoreContextRequest(void *nvm, uint32_t nvm_size)
{
  /* USER CODE BEGIN OnRestoreContextRequest_1 */

  /* USER CODE END OnRestoreContextRequest_1 */
  FLASH_IF_Read(nvm, LORAWAN_NVM_BASE_ADDRESS, nvm_size);
  /* USER CODE BEGIN OnRestoreContextRequest_Last */

  /* USER CODE END OnRestoreContextRequest_Last */
}


/**
  * @brief  STS Lamp Bar timer callback function
  * @param  context ptr of Lamp Bar LED context
  */
static void OnYunhornSTSLampBarColorTimerEvent(void *context)
{
	uint8_t high4=(sts_lamp_bar_color>>4)&0x0f, low4=sts_lamp_bar_color&0x0f;

	UTIL_TIMER_Stop(&STSLampBarColorTimer);

	if (high4==0)
	{
		STS_Lamp_Bar_Set_STS_RGB_Color(sts_lamp_bar_color, luminance_level);
	} else
	{
		STS_Lamp_Bar_Set_STS_RGB_Color(r_b?high4:low4, luminance_level);
		r_b = !r_b;
	}

		  UTIL_TIMER_Start(&STSLampBarColorTimer);
#if 0
#if	defined(STS_O6)||defined(O1L)
	  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP3), CFG_SEQ_Prio_0);

	  UTIL_TIMER_Start(&YunhornSTSLampBarColorTimer);
#endif
#endif
}

/**
  * @brief  SYS occupancy, door lock, motion duration check timer callback function
  * @param  context ptr of duration check context
  */
static void OnYunhornSTSDurationCheckTimerEvent(void *context)
{
	//printf("\r\n----Duration check process ----");
	YunhornSTSDurationCheckTimer();
#ifdef STS_O6

#endif
}

/**
  * @brief  Yunhorn STS Occupancy RSS WakeUP timer callback function
  * @param  context ptr of STS RSS WakeUp context
  */

static void OnYunhornSTSOORSSWakeUpTimerEvent(void *context)
{
#ifdef STS_O6

#endif

}

/**
  * @brief  Yunhorn STS Heart beat timer callback function
  * @param  context ptr of context
  */

static void OnYunhornSTSHeartBeatTimerEvent(void *context)
{
//	  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventRFAC), CFG_SEQ_Prio_0);
	UTIL_TIMER_Stop(&YunhornSTSHeartBeatTimer);

	uint8_t appHeartBeatDataPort=2, appHeartBeatBufferSize=2, appHeartBeatDataBuffer[32]={0x0};

    if ((rfac_timer <(STS_BURN_IN_RFAC+3))&&(sts_cfg_nvm.ac[0]==0x0)&&(sts_cfg_nvm.ac[19]==0x0))
    {
    	//APP_LOG(TS_OFF, VLEVEL_M, "\n\n RFAC_TIMER = %d\n\n", rfac_timer);

    	//STS_YunhornSTSEventRFAC_Process();
    	// the following doesn't executed
#if 1
    	//APP_LOG(TS_OFF, VLEVEL_M, "\n Start send RFAC request \n");
    	appHeartBeatBufferSize = 4;
    	UTIL_MEM_cpy_8((uint8_t*)appHeartBeatDataBuffer,"RFAC",4);
        STS_SENSOR_Upload_Message(YUNHORN_STS_USER_APP_CTRL_REPLY_PORT, appHeartBeatBufferSize, (uint8_t*)appHeartBeatDataBuffer);
#endif
  			rfac_timer ++;
    } else { // normal heart-beat process

#if 1
#ifdef STS_P2
	appHeartBeatDataPort = YUNHORN_STS_P2_LORA_APP_HTBT_PORT;
#elif defined(STS_R1)
	appHeartBeatDataPort = YUNHORN_STS_R1_LORA_APP_HTBT_PORT;
#elif defined(STS_R1D)
	appHeartBeatDataPort = YUNHORN_STS_R1D_LORA_APP_HTBT_PORT;
#elif defined(STS_R5)
	appHeartBeatDataPort = YUNHORN_STS_R5_LORA_APP_HTBT_PORT;
#elif defined(STS_R4)
	appHeartBeatDataPort = YUNHORN_STS_R4_LORA_APP_HTBT_PORT;
#elif defined(STS_T6)
	appHeartBeatDataPort = YUNHORN_STS_T6_LORA_APP_HTBT_PORT;
#elif defined(L8)
	appHeartBeatDataPort = YUNHORN_STS_L8_LORA_APP_HTBT_PORT;
#endif

	appHeartBeatBufferSize = 2;
	appHeartBeatDataBuffer[0]=(uint8_t)(0x80|AppLedStateOn);
	appHeartBeatDataBuffer[1]=(uint8_t)(SYS_GetBatteryLevel()/100);  //TODO XXX change to battery level in mV
	APP_LOG(TS_OFF, VLEVEL_M, "\n\n HEART-BEAT TIMER = %d\n\n", rfac_timer);
    STS_SENSOR_Upload_Message(appHeartBeatDataPort, appHeartBeatBufferSize, (uint8_t*)appHeartBeatDataBuffer);

#endif

    }

	UTIL_TIMER_Start(&YunhornSTSHeartBeatTimer);
}


/**
  * @brief  Yunhorn STS Heart Beat Periodicity Chagne function
  * @param  duration of periodicty in ms (1/1000 sec)
  */
void OnYunhornSTSHeartBeatPeriodicityChanged(uint32_t periodicity)
{
  /* USER CODE BEGIN OnYunhornSTSHeartBeatPeriodicityChanged_1 */

  /* USER CODE END OnYunhornSTSHeartBeatPeriodicityChanged_1 */

  if (periodicity == 0)
  {
    /* Revert to application default Heat-beat periodicity */
	  periodicity = 10*APP_TX_DUTYCYCLE;		//10*10 000 ms
  }

  /* Update timer YunhornSTSHeartBeatTimer */

	  UTIL_TIMER_Stop(&YunhornSTSHeartBeatTimer);
	  UTIL_TIMER_SetPeriod(&YunhornSTSHeartBeatTimer, periodicity);
	  UTIL_TIMER_Start(&YunhornSTSHeartBeatTimer);

  /* USER CODE BEGIN OnYunhornSTSHeartBeatPeriodicityChanged_2 */
  APP_LOG(TS_OFF, VLEVEL_M,"* STS HeartBeatPeriodicity = %u (sec)\r\n", periodicity/1000 );

  /* USER CODE END OnYunhornSTSHeartBeatPeriodicityChanged_2 */
}

/* USER CODE BEGIN PrFD_YunhornSTSWakeUpScanTimerEvents */
static void OnYunhornSTSWakeUpScanTimerEvent(void *context)
{
#if	defined(STS_P2)||defined(STS_T6)||defined(L8)
	UTIL_TIMER_Stop(&YunhornSTSWakeUpScanTimer);

  UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP5), CFG_SEQ_Prio_0);

  UTIL_TIMER_Start(&YunhornSTSWakeUpScanTimer);
#endif

}

void STSWakeupScanTimerStop(void)
{
	UTIL_TIMER_Stop(&YunhornSTSWakeUpScanTimer);
}

uint32_t STS_Get_Date_Time_Stamp(void)
{
	struct tm localtime={0};

	SysTime_t UnixEpoch = SysTimeGet();
	UnixEpoch.Seconds -= 18; /*removing leap seconds*/

	SysTimeLocalTime(UnixEpoch.Seconds,  &localtime);
	APP_LOG(TS_OFF, VLEVEL_M, "UTC TIME:%02dh%02dm%02ds on %02d/%02d/%04d\r\n",
						            localtime.tm_hour, localtime.tm_min, localtime.tm_sec,
						            localtime.tm_mday, localtime.tm_mon + 1, localtime.tm_year + 1900);

	return (uint32_t)UnixEpoch.Seconds;
}

void STSWakeupScanTimerStart(void)
{
  UTIL_TIMER_Start(&YunhornSTSWakeUpScanTimer);
}
/**
  * @brief  Yunhorn STS Tx Periodicity Change function
  * @param  duration of periodicty in ms (1/1000 sec)
  */
void OnYunhornSTSTxPeriodicityChanged(uint32_t periodicity)
{
  /* USER CODE BEGIN OnYunhornSTSTxPeriodicityChanged */

  /* USER CODE END OnYunhornSTSTxPeriodicityChanged */

  /* Update timer OnYunhornSTSTxPeriodicityChanged */
	OnTxPeriodicityChanged(periodicity);
	/*
	  UTIL_TIMER_Stop(&TxTimer);
	  TxPeriodicity = periodicity;
	  UTIL_TIMER_SetPeriod(&TxTimer, TxPeriodicity);
	  UTIL_TIMER_Start(&TxTimer);
	  */

  /* USER CODE BEGIN OnYunhornSTSTxPeriodicityChanged */

  APP_LOG(TS_OFF, VLEVEL_H,"\n* STS TxPeriodicity = %u (sec)\r\n", TxPeriodicity/1000 );

  /* USER CODE END OnYunhornSTSTxPeriodicityChanged */
}