Module_CSU3_Relay_CSRHx/CSRHO-00-RW V2/Src/freertos.c

/* USER CODE BEGIN Header */
/**
 ******************************************************************************
 * File Name          : freertos.c
 * Description        : Code for freertos applications
 ******************************************************************************
 * @attention
 *
 * <h2><center>&copy; Copyright (c) 2019 STMicroelectronics.
 * All rights reserved.</center></h2>
 *
 * This software component is licensed by ST under Ultimate Liberty license
 * SLA0044, the "License"; You may not use this file except in compliance with
 * the License. You may obtain a copy of the License at:
 *                             www.st.com/SLA0044
 *
 ******************************************************************************
 */
/* USER CODE END Header */

/* Includes ------------------------------------------------------------------*/
#include "FreeRTOS.h"
#include "task.h"
#include "main.h"
#include "cmsis_os.h"

/* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */
#include <stdlib.h>
#include "adc.h"
#include "crc.h"
#include "flash_if.h"
#include "sine.h"
#include "usart.h"
#include "tim.h"
#include "can.h"

/* USER CODE END Includes */

/* Private typedef -----------------------------------------------------------*/
/* USER CODE BEGIN PTD */

/* USER CODE END PTD */

/* Private define ------------------------------------------------------------*/
/* USER CODE BEGIN PD */
#define PROTOCOL_HEAD											0xaa
#define PROTOCOL_ADDR (nBoard_Addr) // 0x01:AUX PWR     0x02: FAN BD    0x03:RLY BD		0xff:Any
#define PROTOCOL_ADDR_BROADCAST 0xff

#define PROTOCOL_MESSAGE_QUERY_FW_VER							0x01
#define PROTOCOL_MESSAGE_QUERY_HW_VER 							0x02
#define PROTOCOL_MESSAGE_QUERY_PRESENT_INPUT_VOLTAGE			0x03
#define PROTOCOL_MESSAGE_QUERY_PRESENT_OUTPUT_VOLTAGE  			0x04
#define PROTOCOL_MESSAGE_QUERY_FAN_SPEED 						0x05
#define PROTOCOL_MESSAGE_QUERY_TEMPERATURE 						0x06
#define PROTOCOL_MESSAGE_QUERY_AUX_POWER_VOLTAGE				0x07
#define PROTOCOL_MESSAGE_QUERY_GFD_ADC_VALUE					0x09
#define PROTOCOL_MESSAGE_QUERY_INPUT_GPIO_STATUS 				0x0A
#define PROTOCOL_MESSAGE_QUERY_ALARM_LOG 						0x22
#define PROTOCOL_MESSAGE_QUERY_SN 								0x23
#define PROTOCOL_MESSAGE_QUERY_MODEL_NAME 						0x24
#define PROTOCOL_MESSAGE_QUERY_PARAMETER 						0x25
#define PROTOCOL_MESSAGE_QUERY_ALARM_CODE						0x29
#define PROTOCOL_MESSAGE_QUERY_BATTERY_VOLTAGE_IN    		    0x38 
#define PROTOCOL_MESSAGE_QUERY_OUTPUT_RELAY_OUTPUT_STATUS		0x3A
#define PROTOCOL_MESSAGE_QUERY_BRIDGE_RELAY_OUTPUT_STATUS		0x3B
#define PROTOCOL_MESSAGE_QUERY_SELF_TEST_STATUS					0x3C


#define PROTOCOL_MESSAGE_CONFIG_FAN_SPEED 						0x81
#define PROTOCOL_MESSAGE_CONFIG_SN 								0x82
#define PROTOCOL_MESSAGE_CONFIG_MODEL_NAME 						0x83
#define PROTOCOL_MESSAGE_CONFIG_PARAMETER 						0x84
#define PROTOCOL_MESSAGE_CONFIG_GPIO_OUTPUT 					0x86
#define PROTOCOL_MESSAGE_CONFIG_GFD_VALUE 						0x8B
#define PROTOCOL_MESSAGE_CONFIG_RUN_SELF_TEST					0x92
#define PROTOCOL_MESSAGE_CONFIG_OUTPUT_RELAY_OUTPUT				0x98
#define PROTOCOL_MESSAGE_CONFIG_BRIDGE_RELAY_OUTPUT				0x99


#define PROTOCOL_MESSAGE_UPGRADE_START 							0xe0
#define PROTOCOL_MESSAGE_UPGRADE_ABOARD							0xe1
#define PROTOCOL_MESSAGE_UPGRADE_TRANS 							0xe2
#define PROTOCOL_MESSAGE_UPGRADE_STOP 							0xe3

#define USER_MESSAGE_QUERY_SENSE_GFD							0xF1
#define USER_MESSAGE_QUERY_SENSE_DC_VOLTAGE						0xF2

#define Multi_Relay_Delay_Time 200	//unit:ms
#define WeldingCMDDelay 10			//unit:100ms



/* USER CODE END PD */

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

/* USER CODE END PM */

/* Private variables ---------------------------------------------------------*/
/* USER CODE BEGIN Variables */

// RB v4.0
// const uint32_t  mem_def_data[20]={0xaf00984, 0x89807f9, 0x64005d5, 0xaf00989, 0x8980802, \
//	                          0x64005da, 0xaf00986, 0x8980800, 0x64005db, 0x251c2516,
//	                          0x5dc05e5, 0x251c250f,0x5dc05dd, 0x128e12c0, 0x3b604ae,
//	                          0x128e1284, 0x3b604a4, 0, 0, 0 };
// RB v4.0 (base on the situation of removing diode condition.)

//L1~L3 SMR1~SMR6 GFD-L~FGD-R
const uint32_t mem_def_data[27] = {0x0AEF0A2B, 0x08960800, 0x063F05D4, 						//L1 3 point
								   0x0AEF0A29, 0x089607FF, 0x063F05D3, 						//L2 3 point	
								   0x0AEF0A29, 0x08960802, 0x063F05D5, 						//L3 3 point
								   0x251C2505, 0x05DC05DD, 0x251C250F, 0x05DC05DB, 			//SMR1,SMR2 DCV 2 point
								   0x251C2505, 0x05DC05DD, 0x251C250F, 0x05DC05DB,			//SMR3,SMR4 DCV 2 point
								   0x251C2505, 0x05DC05DD, 0x251C250F, 0x05DC05DB,			//SMR5,SMR6 DCV 2 point
								   0x128E13E4, 0x03B604CF, 0x128E139D, 0x03B604D0, 			//LGFD,RGFD 2 point
								   0x251C2505, 0x05DC05DD									//DC IN 2 point
								  };

__IO uint32_t flashdestination;
__IO uint32_t newdestination;

//uint8_t test;
uint8_t test[8];

/* USER CODE END Variables */
osThreadId defaultTaskHandle;
osThreadId uart1TaskHandle;
osThreadId adc1TaskHandle;
osThreadId adc2TaskHandle;
osThreadId adc3TaskHandle;
osThreadId gpioTaskHandle;
osThreadId memoryTaskHandle;
osThreadId InkeyTaskHandle;
osThreadId gfd_left_TaskHandle;
osThreadId gfd_right_TaskHandle;
osThreadId sf_test_TaskHandle;
osThreadId _ledTask_Handle;
osThreadId CANTaskHandle;

/* Private function prototypes -----------------------------------------------*/
/* USER CODE BEGIN FunctionPrototypes */
uint8_t isValidCheckSum(void);
void CLC_Corr_Gain_Par(uint16_t SpecData_H, uint16_t SpecData_L, uint16_t MCUData_H, uint16_t MCUData_L, float *GainA, float *GainB);
uint16_t acVolCalWithGain(uint16_t orgValue, uint8_t phase);
void nTestIO(GPIO_TypeDef *GPIO_out_port, uint16_t GPIO_out_Pin, GPIO_TypeDef *GPIO_in_port, uint16_t GPIO_in_Pin, uint8_t nItem);
void nTestIO1(GPIO_TypeDef *GPIO_out_port, uint16_t GPIO_out_Pin, GPIO_TypeDef *GPIO_in_port, uint16_t GPIO_in_Pin, uint8_t nItem);
void nTestEXT_INT(GPIO_TypeDef *GPIO_out_port, uint16_t GPIO_out_Pin, uint8_t *flag, uint8_t nItem);

void nTestIO_2(GPIO_TypeDef *GPIO_out_port, uint16_t GPIO_out_Pin,
			   GPIO_TypeDef *GPIO_out2_port, uint16_t GPIO_out2_Pin, GPIO_TypeDef *GPIO_in_port, uint16_t GPIO_in_Pin, uint8_t nItem);
void IOdebug(void);			   
/* USER CODE END FunctionPrototypes */

void StartDefaultTask(void const * argument);
void Uart1Task(void const * argument);
void Adc1Task(void const * argument);
void Adc2Task(void const * argument);
void Adc3Task(void const * argument);
void GpioTask(void const * argument);
void MemoryTask(void const * argument);
void Inkey_Task(void const * argument);
void Gfd_Left_Task(void const * argument);
void Gfd_Right_Task(void const * argument);
void SF_Test_Task(void const * argument);
void LedTask(void const * argument);
void canTask(void const * argument);

void MX_FREERTOS_Init(void); /* (MISRA C 2004 rule 8.1) */

/* GetIdleTaskMemory prototype (linked to static allocation support) */
void vApplicationGetIdleTaskMemory( StaticTask_t **ppxIdleTaskTCBBuffer, StackType_t **ppxIdleTaskStackBuffer, uint32_t *pulIdleTaskStackSize );

/* USER CODE BEGIN GET_IDLE_TASK_MEMORY */
static StaticTask_t xIdleTaskTCBBuffer;
static StackType_t xIdleStack[configMINIMAL_STACK_SIZE];

void vApplicationGetIdleTaskMemory(StaticTask_t **ppxIdleTaskTCBBuffer, StackType_t **ppxIdleTaskStackBuffer, uint32_t *pulIdleTaskStackSize)
{
	*ppxIdleTaskTCBBuffer = &xIdleTaskTCBBuffer;
	*ppxIdleTaskStackBuffer = &xIdleStack[0];
	*pulIdleTaskStackSize = configMINIMAL_STACK_SIZE;
	/* place for user code */
}
/* USER CODE END GET_IDLE_TASK_MEMORY */

/**
  * @brief  FreeRTOS initialization
  * @param  None
  * @retval None
  */
void MX_FREERTOS_Init(void) {
  /* USER CODE BEGIN Init */
	// Version info configuration
	memset(&Module_Info.Soft_Ver_Ptr[0], 0x00, ARRAY_SIZE(Module_Info.Soft_Ver_Ptr));
	memset(&Module_Info.Hard_Ver_Ptr[0], 0x00, ARRAY_SIZE(Module_Info.Hard_Ver_Ptr));

	sprintf((char *)Module_Info.Soft_Ver_Ptr, "V0.02.R3");			

	if(nBoard_Addr == MainRelay){
		sprintf((char *)Module_Info.Hard_Ver_Ptr, "CSRHO_M0");
	}else if(nBoard_Addr == GunRelay){ 	
		sprintf((char *)Module_Info.Hard_Ver_Ptr, "CSRHO_G0");
	}else if(nBoard_Addr == MainBridge1){ 	
		sprintf((char *)Module_Info.Hard_Ver_Ptr, "CSRHB_10");
	}else if(nBoard_Addr == MainBridge2){ 	
		sprintf((char *)Module_Info.Hard_Ver_Ptr, "CSRHB_20");
	}else if(nBoard_Addr == MainBridge3){ 	
		sprintf((char *)Module_Info.Hard_Ver_Ptr, "CSRHB_30");
	}else{ 	
		sprintf((char *)Module_Info.Hard_Ver_Ptr, "Undefine");
	}	


  /* USER CODE END Init */

  /* USER CODE BEGIN RTOS_MUTEX */
	/* add mutexes, ... */
  /* USER CODE END RTOS_MUTEX */

  /* USER CODE BEGIN RTOS_SEMAPHORES */
	/* add semaphores, ... */
  /* USER CODE END RTOS_SEMAPHORES */

  /* USER CODE BEGIN RTOS_TIMERS */
	/* start timers, add new ones, ... */
  /* USER CODE END RTOS_TIMERS */

  /* USER CODE BEGIN RTOS_QUEUES */
	/* add queues, ... */
  /* USER CODE END RTOS_QUEUES */

  /* Create the thread(s) */
  /* definition and creation of defaultTask */
  osThreadDef(defaultTask, StartDefaultTask, osPriorityIdle, 0, 128);
  defaultTaskHandle = osThreadCreate(osThread(defaultTask), NULL);

  /* definition and creation of uart1Task */
  osThreadDef(uart1Task, Uart1Task, osPriorityAboveNormal, 0, 1024);
  uart1TaskHandle = osThreadCreate(osThread(uart1Task), NULL);

  /* definition and creation of adc1Task */
  osThreadDef(adc1Task, Adc1Task, osPriorityNormal, 0, 512);
  adc1TaskHandle = osThreadCreate(osThread(adc1Task), NULL);

  /* definition and creation of adc2Task */
  osThreadDef(adc2Task, Adc2Task, osPriorityNormal, 0, 1024);
  adc2TaskHandle = osThreadCreate(osThread(adc2Task), NULL);

  /* definition and creation of adc3Task */
  osThreadDef(adc3Task, Adc3Task, osPriorityNormal, 0, 128);
  adc3TaskHandle = osThreadCreate(osThread(adc3Task), NULL);

  /* definition and creation of gpioTask */
  osThreadDef(gpioTask, GpioTask, osPriorityNormal, 0, 128);
  gpioTaskHandle = osThreadCreate(osThread(gpioTask), NULL);

  /* definition and creation of memoryTask */
  osThreadDef(memoryTask, MemoryTask, osPriorityIdle, 0, 256);
  memoryTaskHandle = osThreadCreate(osThread(memoryTask), NULL);

  /* definition and creation of InkeyTask */
  osThreadDef(InkeyTask, Inkey_Task, osPriorityAboveNormal, 0, 128);
  InkeyTaskHandle = osThreadCreate(osThread(InkeyTask), NULL);

  /* definition and creation of gfd_left_Task */
  osThreadDef(gfd_left_Task, Gfd_Left_Task, osPriorityAboveNormal, 0, 128);
  gfd_left_TaskHandle = osThreadCreate(osThread(gfd_left_Task), NULL);

  /* definition and creation of gfd_right_Task */
  osThreadDef(gfd_right_Task, Gfd_Right_Task, osPriorityAboveNormal, 0, 128);
  gfd_right_TaskHandle = osThreadCreate(osThread(gfd_right_Task), NULL);

  /* definition and creation of sf_test_Task */
  osThreadDef(sf_test_Task, SF_Test_Task, osPriorityNormal, 0, 128);
  sf_test_TaskHandle = osThreadCreate(osThread(sf_test_Task), NULL);

  /* definition and creation of _ledTask_ */
  osThreadDef(_ledTask_, LedTask, osPriorityIdle, 0, 128);
  _ledTask_Handle = osThreadCreate(osThread(_ledTask_), NULL);

  /* definition and creation of CANTask */
  osThreadDef(CANTask, canTask, osPriorityAboveNormal, 0, 256);
  CANTaskHandle = osThreadCreate(osThread(CANTask), NULL);

  /* USER CODE BEGIN RTOS_THREADS */
	/* add threads, ... */
  /* USER CODE END RTOS_THREADS */

}

/* USER CODE BEGIN Header_StartDefaultTask */
/**
 * @brief  Function implementing the defaultTask thread.
 * @param  argument: Not used
 * @retval None
 */
/* USER CODE END Header_StartDefaultTask */
void StartDefaultTask(void const * argument)
{
  /* USER CODE BEGIN StartDefaultTask */
	/* Infinite loop */
	printf("FW:%s\n\r", Module_Info.Soft_Ver_Ptr);
	printf("PCB Define:%s\n\r", Module_Info.Hard_Ver_Ptr);
	for (;;)
	{		

		if (bRelayFeedback == 1)
		{
			bRelayFeedback = 0;

#if (FEEDBACK_PIN == 1)		
			Module_Info.Relay_Status.flags.SMR1_relay_n = ~HAL_GPIO_ReadPin(SMR1_Relay_n_Ret_GPIO_Port, SMR1_Relay_n_Ret_Pin);
			Module_Info.Relay_Status.flags.SMR1_relay_p = ~HAL_GPIO_ReadPin(SMR1_Relay_p_Ret_GPIO_Port, SMR1_Relay_p_Ret_Pin);
			Module_Info.Relay_Status.flags.SMR2_relay_n = ~HAL_GPIO_ReadPin(SMR2_Relay_n_Ret_GPIO_Port, SMR2_Relay_n_Ret_Pin);
			Module_Info.Relay_Status.flags.SMR2_relay_p = ~HAL_GPIO_ReadPin(SMR2_Relay_p_Ret_GPIO_Port, SMR2_Relay_p_Ret_Pin);
#endif
		}

#if (DEBUG_PRINTF == 1)		
			// Module_Info.Relay_Status.flags.SMR1_relay_n = ~HAL_GPIO_ReadPin(SMR1_Relay_n_Ret_GPIO_Port, SMR1_Relay_n_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR1_relay_p = ~HAL_GPIO_ReadPin(SMR1_Relay_p_Ret_GPIO_Port, SMR1_Relay_p_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR2_relay_n = ~HAL_GPIO_ReadPin(SMR2_Relay_n_Ret_GPIO_Port, SMR2_Relay_n_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR2_relay_p = ~HAL_GPIO_ReadPin(SMR2_Relay_p_Ret_GPIO_Port, SMR2_Relay_p_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR3_relay_n = ~HAL_GPIO_ReadPin(SMR3_Relay_n_Ret_GPIO_Port, SMR3_Relay_n_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR3_relay_p = ~HAL_GPIO_ReadPin(SMR3_Relay_p_Ret_GPIO_Port, SMR3_Relay_p_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR4_relay_n = ~HAL_GPIO_ReadPin(SMR4_Relay_n_Ret_GPIO_Port, SMR4_Relay_n_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR4_relay_p = ~HAL_GPIO_ReadPin(SMR4_Relay_p_Ret_GPIO_Port, SMR4_Relay_p_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR5_relay_n = ~HAL_GPIO_ReadPin(SMR5_Relay_n_Ret_GPIO_Port, SMR5_Relay_n_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR5_relay_p = ~HAL_GPIO_ReadPin(SMR5_Relay_p_Ret_GPIO_Port, SMR5_Relay_p_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR6_relay_n = ~HAL_GPIO_ReadPin(SMR6_Relay_n_Ret_GPIO_Port, SMR6_Relay_n_Ret_Pin);
			// Module_Info.Relay_Status.flags.SMR6_relay_p = ~HAL_GPIO_ReadPin(SMR6_Relay_p_Ret_GPIO_Port, SMR6_Relay_p_Ret_Pin);

			// printf("Relay Set	    = %014llx \n\r",Module_Info.Relay_IO.All);
			// printf("Relay Status = %014llx \n\r\n\r",Module_Info.Relay_Status.All);



//		printf("Dip_Switch = %d \n\r", Module_Info.gfd_chk[1].R_GFD_v);
		
				//printf(" ADC1 = %d ADC2 = %d ADC3 = %d ADC4 = %d ADC5 = %d \n\r", adc_value.ADC1_IN0.value,
				//		adc_value.ADC1_IN1.value,adc_value.ADC1_IN2.value,adc_value.ADC1_IN3.value,adc_value.ADC1_IN4.value);
				//printf(" ADC6 = %d ADC7 = %d ADC8 = %d ADC9 = %d \n\r", adc_value.ADC1_IN5.value,
				//		adc_value.ADC1_IN6.value,adc_value.ADC1_IN7.value,adc_value.ADC1_IN8.value);

				//printf("SMR6 = %d \n\r",Module_Info.SMR6_Relay_V);				

//		printf(" CT1 = %d , CT2 = %d , ADC_1 = %f,  ADC_2 = %f \n\r", Module_Info.SMR1_Relay_C,
//			   Module_Info.SMR2_Relay_C, c_vadc[0], c_vadc[1]); // 100A = 1000

		vTaskDelay(2000 / portTICK_RATE_MS);
#else

		osDelay(1);
#endif
	}

  /* USER CODE END StartDefaultTask */
}

/* USER CODE BEGIN Header_Uart1Task */
/**
 * @brief Function implementing the uart1Task thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_Uart1Task */
void Uart1Task(void const * argument)
{
  /* USER CODE BEGIN Uart1Task */
	/* Infinite loop */
	uint8_t tx[UART_BUFFER_SIZE];
	uint8_t tx_len;
	uint8_t chksum = 0;
	uint8_t endFlag[4] = {0x55, 0xaa, 0x55, 0xaa};
	uint32_t flash, crc32;
	uint16_t temp, SMR1_Gfd_Diff, SMR2_Gfd_Diff;
	uint16_t nSMR1_Sense, nSMR2_Sense, nSMR3_Sense,nSMR4_Sense,nSMR5_Sense,nSMR6_Sense,nVer165, SMR1_Gfd_Sense, SMR2_Gfd_Sense;

	// uint16_t delay = 100;
	for (;;)
	{		

				// osDelay(delay);
				// chksum = 0;

				// Exti.EXTI_SMR1_Flag = true;
				// Exti.Status  = 0xff;

				// uart_recv_end_flag = 1;
				// uart_rx_buffer[0] = 0xAA;	
				// uart_rx_buffer[2] = MainRelay;
				// uart_rx_buffer[3] = PROTOCOL_MESSAGE_CONFIG_OUTPUT_RELAY_OUTPUT;
				// uart_rx_buffer[4] = 7;
				// uart_rx_buffer[5] = 0;
				// uart_rx_buffer[6] = test[0];
				// uart_rx_buffer[7] = test[1];
				// uart_rx_buffer[8] = test[2];
				// uart_rx_buffer[9] = test[3];
				// uart_rx_buffer[10] = test[4];
				// uart_rx_buffer[11] = test[5];
				// uart_rx_buffer[12] = test[6];

				// for (int idx = 0; idx < (uart_rx_buffer[4] | (uart_rx_buffer[5] << 8)); idx++){
				// 		chksum ^= uart_rx_buffer[6 + idx];
				// }
							
				// uart_rx_buffer[13] = chksum;

				// if(delay < 1500)
				// {
				// 	delay += 100;					
				// }
				// else
				// {
				// 	Exti.EXTI_SMR1_Flag = true;
				// 	delay = 100;					
				// }
				// printf("%d\r\n",delay);
		
			if (uart_recv_end_flag == 1)
			{
				// printf(" %x %x %x %x %x %x\n\r", uart_rx_buffer[0],uart_rx_buffer[1],uart_rx_buffer[2],uart_rx_buffer[3],uart_rx_buffer[4],uart_rx_buffer[5]);
				chksum = 0;
				if ((uart_rx_buffer[2] == PROTOCOL_ADDR) || (uart_rx_buffer[2] == PROTOCOL_ADDR_BROADCAST))
				{
					if (isValidCheckSum() == ON)
					{						
						switch (uart_rx_buffer[3])
						{
						case USER_MESSAGE_QUERY_SENSE_DC_VOLTAGE:
							tx_len = 35;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = USER_MESSAGE_QUERY_SENSE_DC_VOLTAGE;
							tx[4] = 28;
							tx[5] = 0;

							tx[6] = ((Module_Info.SMR1_Relay_C >> 0) & 0xff);
							tx[7] = ((Module_Info.SMR1_Relay_C >> 8) & 0xff);							
							tx[8] = ((Module_Info.SMR2_Relay_C >> 0) & 0xff);
							tx[9] = ((Module_Info.SMR2_Relay_C >> 8) & 0xff);
							tx[10] = ((Module_Info.SMR1_Relay_V >> 0) & 0xff);
							tx[11] = ((Module_Info.SMR1_Relay_V >> 8) & 0xff);
							tx[12] = ((Module_Info.SMR2_Relay_V >> 0) & 0xff);
							tx[13] = ((Module_Info.SMR2_Relay_V >> 8) & 0xff);		
							tx[14] = ((Module_Info.SMR3_Relay_V >> 0) & 0xff);
							tx[15] = ((Module_Info.SMR3_Relay_V >> 8) & 0xff);			
							tx[16] = ((Module_Info.SMR4_Relay_V >> 0) & 0xff);
							tx[17] = ((Module_Info.SMR4_Relay_V >> 8) & 0xff);			
							tx[18] = ((Module_Info.SMR5_Relay_V >> 0) & 0xff);
							tx[19] = ((Module_Info.SMR5_Relay_V >> 8) & 0xff);			
							tx[20] = ((Module_Info.SMR6_Relay_V >> 0) & 0xff);
							tx[21] = ((Module_Info.SMR6_Relay_V >> 8) & 0xff);								

							nSMR1_Sense = (uint16_t)adc_value.ADC1_IN0.value;
							nSMR2_Sense = (uint16_t)adc_value.ADC1_IN2.value;
							nSMR3_Sense = (uint16_t)adc_value.ADC1_IN5.value;
							nSMR4_Sense = (uint16_t)adc_value.ADC1_IN6.value;
							nSMR5_Sense = (uint16_t)adc_value.ADC1_IN7.value;
							nSMR6_Sense = (uint16_t)adc_value.ADC1_IN8.value;

							
							tx[22] = ((nSMR1_Sense >> 0) & 0xff);
							tx[23] = ((nSMR1_Sense >> 8) & 0xff);
							tx[24] = ((nSMR2_Sense >> 0) & 0xff);
							tx[25] = ((nSMR2_Sense >> 8) & 0xff);
							tx[26] = ((nSMR3_Sense >> 0) & 0xff);
							tx[27] = ((nSMR3_Sense >> 8) & 0xff);
							tx[28] = ((nSMR4_Sense >> 0) & 0xff);
							tx[29] = ((nSMR4_Sense >> 8) & 0xff);
							tx[30] = ((nSMR5_Sense >> 0) & 0xff);
							tx[31] = ((nSMR5_Sense >> 8) & 0xff);
							tx[32] = ((nSMR6_Sense >> 0) & 0xff);
							tx[33] = ((nSMR6_Sense >> 8) & 0xff);


							//tx[18] = ((Module_Info.BAT_Voltage >> 0) & 0xff);
							//tx[19] = ((Module_Info.BAT_Voltage >> 8) & 0xff);
							//tx[20] = ((nBat1_Sense >> 0) & 0xff);
							//tx[21] = ((nBat1_Sense >> 8) & 0xff);

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[34] = chksum;
							break;

						case USER_MESSAGE_QUERY_SENSE_GFD:
							tx_len = 29;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = USER_MESSAGE_QUERY_SENSE_GFD;
							tx[4] = 22;
							tx[5] = 0x00;
							
							if (Module_Info.gfd_chk[0].bResult_Gfd == GFD_FAIL)
							{
								tx[6] = (((Module_Info.gfd_chk[0].R_GFD_Fail / 1000) >> 0) & 0xff); // Gfd Resistor
								tx[7] = (((Module_Info.gfd_chk[0].R_GFD_Fail / 1000) >> 8) & 0xff);

								tx[8] = ((Module_Info.gfd_chk[0].SMR_Voltage_Fail >> 0) & 0xff);
								tx[9] = ((Module_Info.gfd_chk[0].SMR_Voltage_Fail >> 8) & 0xff);
								tx[11] = Module_Info.gfd_chk[0].Rfd_State_Fail;
							}
							else
							{
								tx[6] = (((Module_Info.gfd_chk[0].R_GFD_v / 1000) >> 0) & 0xff); // Gfd Resistor
								tx[7] = (((Module_Info.gfd_chk[0].R_GFD_v / 1000) >> 8) & 0xff);

								tx[8] = ((Module_Info.SMR1_Relay_V >> 0) & 0xff);
								tx[9] = ((Module_Info.SMR1_Relay_V >> 8) & 0xff);
								tx[11] = Module_Info.gfd_chk[0].Rfd_State;
							}

							tx[10] = Module_Info.gfd_chk[0].bResult_Gfd;
							
							if (Module_Info.gfd_chk[1].bResult_Gfd == GFD_FAIL)
							{
								tx[12] = (((Module_Info.gfd_chk[1].R_GFD_Fail / 1000) >> 0) & 0xff); // Gfd Resistor
								tx[13] = (((Module_Info.gfd_chk[1].R_GFD_Fail / 1000) >> 8) & 0xff);

								tx[14] = ((Module_Info.gfd_chk[1].SMR_Voltage_Fail >> 0) & 0xff);
								tx[15] = ((Module_Info.gfd_chk[1].SMR_Voltage_Fail >> 8) & 0xff);
								tx[17] = Module_Info.gfd_chk[1].Rfd_State_Fail;
							}
							else
							{
								tx[12] = (((Module_Info.gfd_chk[1].R_GFD_v / 1000) >> 0) & 0xff); // Gfd Resistor
								tx[13] = (((Module_Info.gfd_chk[1].R_GFD_v / 1000) >> 8) & 0xff);

								tx[14] = ((Module_Info.SMR2_Relay_V >> 0) & 0xff);
								tx[15] = ((Module_Info.SMR2_Relay_V >> 8) & 0xff);
								tx[17] = Module_Info.gfd_chk[1].Rfd_State;
							}

							tx[16] = Module_Info.gfd_chk[1].bResult_Gfd;

							//  Verf_165
							nVer165 = (uint16_t)(Module_Info.Vref_165 * 100.0);
							tx[18] = ((nVer165 >> 0) & 0xff);
							tx[19] = ((nVer165 >> 8) & 0xff);

							SMR1_Gfd_Sense = (uint16_t)(Module_Info.SMR_Gfd_Sense[0] * 100.0);
							SMR2_Gfd_Sense = (uint16_t)(Module_Info.SMR_Gfd_Sense[1] * 100.0);
							SMR1_Gfd_Diff = (uint16_t)(Module_Info.SMR_Gfd_Diff[0] * 100.0);
							SMR2_Gfd_Diff = (uint16_t)(Module_Info.SMR_Gfd_Diff[1] * 100.0);

							tx[20] = ((SMR1_Gfd_Sense >> 0) & 0xff);
							tx[21] = ((SMR1_Gfd_Sense >> 8) & 0xff);
							tx[22] = ((SMR2_Gfd_Sense >> 0) & 0xff);
							tx[23] = ((SMR2_Gfd_Sense >> 8) & 0xff);

							tx[24] = ((SMR1_Gfd_Diff >> 0) & 0xff);
							tx[25] = ((SMR1_Gfd_Diff >> 8) & 0xff);
							tx[26] = ((SMR2_Gfd_Diff >> 0) & 0xff);
							tx[27] = ((SMR2_Gfd_Diff >> 8) & 0xff);

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[28] = chksum;

							break;

						case PROTOCOL_MESSAGE_QUERY_FW_VER:
							tx_len = 15;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_FW_VER;
							tx[4] = 0x08;
							tx[5] = 0x00;

							for (int idx = 0; idx < 8; idx++)
								tx[(6 + idx)] = Module_Info.Soft_Ver_Ptr[idx];

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
								chksum ^= tx[(6 + idx)];

							tx[14] = chksum;
							break;

						case PROTOCOL_MESSAGE_QUERY_HW_VER:
							tx_len = 15;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_HW_VER;
							tx[4] = 0x08;
							tx[5] = 0x00;

							for (int idx = 0; idx < 8; idx++)
								tx[(6 + idx)] = Module_Info.Hard_Ver_Ptr[idx];

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
								chksum ^= tx[(6 + idx)];

							tx[14] = chksum;

							break;
						case PROTOCOL_MESSAGE_QUERY_PRESENT_INPUT_VOLTAGE:
							tx_len = 14;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_PRESENT_INPUT_VOLTAGE;
							tx[4] = 0x07;
							tx[5] = 0x00;
							tx[6] = 0;
							tx[7] = ((AC_Sine[0].Vrms_AVG >> 0) & 0xff);
							tx[8] = ((AC_Sine[0].Vrms_AVG >> 8) & 0xff);
							tx[9] = ((AC_Sine[1].Vrms_AVG >> 0) & 0xff);
							tx[10] = ((AC_Sine[1].Vrms_AVG >> 8) & 0xff);
							tx[11] = ((AC_Sine[2].Vrms_AVG >> 0) & 0xff);
							tx[12] = ((AC_Sine[2].Vrms_AVG >> 8) & 0xff);

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
								chksum ^= tx[6 + idx];
							tx[13] = chksum;
							break;			
						case PROTOCOL_MESSAGE_QUERY_BATTERY_VOLTAGE_IN:
							tx_len = 11;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_BATTERY_VOLTAGE_IN;
							tx[4] = 0x04;
							tx[5] = 0x00;
							tx[6] = ((Module_Info.BAT_Voltage>>0) & 0xff);
							tx[7] = ((Module_Info.BAT_Voltage>>8) & 0xff);
							tx[8] = tx[9] = 0;
							
							for(int idx=0;idx<(tx[4] | (tx[5]<<8));idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[10] = chksum;
							break;				
						case PROTOCOL_MESSAGE_QUERY_PRESENT_OUTPUT_VOLTAGE:
							tx_len = 23;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_PRESENT_OUTPUT_VOLTAGE;
							tx[4] = 16;
							tx[5] = 0x00;
							tx[6] = ((Module_Info.SMR1_Relay_C >> 0) & 0xff);
							tx[7] = ((Module_Info.SMR1_Relay_C >> 8) & 0xff);
							tx[8] = ((Module_Info.SMR1_Relay_V >> 0) & 0xff);
							tx[9] = ((Module_Info.SMR1_Relay_V >> 8) & 0xff);
							tx[10] = ((Module_Info.SMR2_Relay_C >> 0) & 0xff);
							tx[11] = ((Module_Info.SMR2_Relay_C >> 8) & 0xff);
							tx[12] = ((Module_Info.SMR2_Relay_V >> 0) & 0xff);
							tx[13] = ((Module_Info.SMR2_Relay_V >> 8) & 0xff);							
							tx[14] = ((Module_Info.SMR3_Relay_V >> 0) & 0xff);
							tx[15] = ((Module_Info.SMR3_Relay_V >> 8) & 0xff);			
							tx[16] = ((Module_Info.SMR4_Relay_V >> 0) & 0xff);
							tx[17] = ((Module_Info.SMR4_Relay_V >> 8) & 0xff);			
							tx[18] = ((Module_Info.SMR5_Relay_V >> 0) & 0xff);
							tx[19] = ((Module_Info.SMR5_Relay_V >> 8) & 0xff);			
							tx[20] = ((Module_Info.SMR6_Relay_V >> 0) & 0xff);
							tx[21] = ((Module_Info.SMR6_Relay_V >> 8) & 0xff);	

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[22] = chksum;

							break;
						case PROTOCOL_MESSAGE_QUERY_OUTPUT_RELAY_OUTPUT_STATUS:						
							tx_len = 14;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = uart_rx_buffer[3];
							tx[4] = 7;
							tx[5] = 0;

							// Read Relay Feedback Pins ......	
							Module_Info.Relay_Status.flags.AC_Contactor = ~HAL_GPIO_ReadPin(AC_Contactor_Ret_GPIO_Port, AC_Contactor_Ret_Pin);
							Module_Info.Relay_Status.flags.Precharge1 = ~HAL_GPIO_ReadPin(Precharge1_Ret_GPIO_Port, Precharge1_Ret_Pin);
							Module_Info.Relay_Status.flags.Precharge2 = ~HAL_GPIO_ReadPin(Precharge2_Ret_GPIO_Port, Precharge2_Ret_Pin);

							Module_Info.Relay_Status.flags.SMR1_relay_n = ~HAL_GPIO_ReadPin(SMR1_Relay_n_Ret_GPIO_Port, SMR1_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR1_relay_p = ~HAL_GPIO_ReadPin(SMR1_Relay_p_Ret_GPIO_Port, SMR1_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR2_relay_n = ~HAL_GPIO_ReadPin(SMR2_Relay_n_Ret_GPIO_Port, SMR2_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR2_relay_p = ~HAL_GPIO_ReadPin(SMR2_Relay_p_Ret_GPIO_Port, SMR2_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR3_relay_n = ~HAL_GPIO_ReadPin(SMR3_Relay_n_Ret_GPIO_Port, SMR3_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR3_relay_p = ~HAL_GPIO_ReadPin(SMR3_Relay_p_Ret_GPIO_Port, SMR3_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR4_relay_n = ~HAL_GPIO_ReadPin(SMR4_Relay_n_Ret_GPIO_Port, SMR4_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR4_relay_p = ~HAL_GPIO_ReadPin(SMR4_Relay_p_Ret_GPIO_Port, SMR4_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR5_relay_n = ~HAL_GPIO_ReadPin(SMR5_Relay_n_Ret_GPIO_Port, SMR5_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR5_relay_p = ~HAL_GPIO_ReadPin(SMR5_Relay_p_Ret_GPIO_Port, SMR5_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR6_relay_n = ~HAL_GPIO_ReadPin(SMR6_Relay_n_Ret_GPIO_Port, SMR6_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR6_relay_p = ~HAL_GPIO_ReadPin(SMR6_Relay_p_Ret_GPIO_Port, SMR6_Relay_p_Ret_Pin);		

							tx[6] = (Module_Info.Relay_Status.All & 0xff);
							tx[7] = (Module_Info.Relay_Status.All >> 8) & 0xff;							
							tx[8] = (Module_Info.Relay_Status.All >> 16) & 0xff;
							tx[9] = (Module_Info.Relay_Status.All >> 24) & 0xff;
							tx[10] = (Module_Info.Relay_Status.All >> 32) & 0xff;
							tx[11] = (Module_Info.Relay_Status.All >> 40) & 0xff;
							tx[12] = (Module_Info.Relay_Status.All >> 48) & 0xff;
							
								
							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[13] = chksum;
							break;
						case PROTOCOL_MESSAGE_QUERY_BRIDGE_RELAY_OUTPUT_STATUS:
							tx_len = 13;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = uart_rx_buffer[3];
							tx[4] = 6;
							tx[5] = 0;

							// Read Relay Feedback Pins ......	
							Module_Info.Relay_Status.flags.AC_Contactor = ~HAL_GPIO_ReadPin(AC_Contactor_Ret_GPIO_Port, AC_Contactor_Ret_Pin);
							Module_Info.Relay_Status.flags.Precharge1 = ~HAL_GPIO_ReadPin(Precharge1_Ret_GPIO_Port, Precharge1_Ret_Pin);
							Module_Info.Relay_Status.flags.Precharge2 = ~HAL_GPIO_ReadPin(Precharge2_Ret_GPIO_Port, Precharge2_Ret_Pin);

							Module_Info.Relay_Status.flags.SMR1_relay_n = ~HAL_GPIO_ReadPin(SMR1_Relay_n_Ret_GPIO_Port, SMR1_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR1_relay_p = ~HAL_GPIO_ReadPin(SMR1_Relay_p_Ret_GPIO_Port, SMR1_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR2_relay_n = ~HAL_GPIO_ReadPin(SMR2_Relay_n_Ret_GPIO_Port, SMR2_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR2_relay_p = ~HAL_GPIO_ReadPin(SMR2_Relay_p_Ret_GPIO_Port, SMR2_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR3_relay_n = ~HAL_GPIO_ReadPin(SMR3_Relay_n_Ret_GPIO_Port, SMR3_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR3_relay_p = ~HAL_GPIO_ReadPin(SMR3_Relay_p_Ret_GPIO_Port, SMR3_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR4_relay_n = ~HAL_GPIO_ReadPin(SMR4_Relay_n_Ret_GPIO_Port, SMR4_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR4_relay_p = ~HAL_GPIO_ReadPin(SMR4_Relay_p_Ret_GPIO_Port, SMR4_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR5_relay_n = ~HAL_GPIO_ReadPin(SMR5_Relay_n_Ret_GPIO_Port, SMR5_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR5_relay_p = ~HAL_GPIO_ReadPin(SMR5_Relay_p_Ret_GPIO_Port, SMR5_Relay_p_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR6_relay_n = ~HAL_GPIO_ReadPin(SMR6_Relay_n_Ret_GPIO_Port, SMR6_Relay_n_Ret_Pin);
							Module_Info.Relay_Status.flags.SMR6_relay_p = ~HAL_GPIO_ReadPin(SMR6_Relay_p_Ret_GPIO_Port, SMR6_Relay_p_Ret_Pin);		

							tx[6] = (Module_Info.Relay_Status.All & 0xff);
							tx[7] = (Module_Info.Relay_Status.All >> 8) & 0xff;							
							tx[8] = (Module_Info.Relay_Status.All >> 16) & 0xff;
							tx[9] = (Module_Info.Relay_Status.All >> 24) & 0xff;
							tx[10] = (Module_Info.Relay_Status.All >> 32) & 0xff;
							tx[11] = (Module_Info.Relay_Status.All >> 40) & 0xff;	
								
							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[12] = chksum;
							break;	
						case PROTOCOL_MESSAGE_QUERY_GFD_ADC_VALUE:
							tx_len = 19;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_GFD_ADC_VALUE;
							tx[4] = 12;
							tx[5] = 0x00;
							
							if (Module_Info.gfd_chk[0].bResult_Gfd == GFD_FAIL)
							{
								tx[6] = (((Module_Info.gfd_chk[0].R_GFD_Fail / 1000) >> 0) & 0xff); // Gfd Resistor
								tx[7] = (((Module_Info.gfd_chk[0].R_GFD_Fail / 1000) >> 8) & 0xff);

								tx[8] = ((Module_Info.gfd_chk[0].SMR_Voltage_Fail >> 0) & 0xff);
								tx[9] = ((Module_Info.gfd_chk[0].SMR_Voltage_Fail >> 8) & 0xff);
								tx[11] = Module_Info.gfd_chk[0].Rfd_State_Fail;
							}
							else
							{
								tx[6] = (((Module_Info.gfd_chk[0].R_GFD_v / 1000) >> 0) & 0xff); // Gfd Resistor
								tx[7] = (((Module_Info.gfd_chk[0].R_GFD_v / 1000) >> 8) & 0xff);

								tx[8] = ((Module_Info.SMR1_Relay_V >> 0) & 0xff);
								tx[9] = ((Module_Info.SMR1_Relay_V >> 8) & 0xff);
								tx[11] = Module_Info.gfd_chk[0].Rfd_State;
							}

							tx[10] = Module_Info.gfd_chk[0].bResult_Gfd;
							
							if (Module_Info.gfd_chk[1].bResult_Gfd == GFD_FAIL)
							{
								tx[12] = (((Module_Info.gfd_chk[1].R_GFD_Fail / 1000) >> 0) & 0xff); // Gfd Resistor
								tx[13] = (((Module_Info.gfd_chk[1].R_GFD_Fail / 1000) >> 8) & 0xff);

								tx[14] = ((Module_Info.gfd_chk[1].SMR_Voltage_Fail >> 0) & 0xff);
								tx[15] = ((Module_Info.gfd_chk[1].SMR_Voltage_Fail >> 8) & 0xff);
								tx[17] = Module_Info.gfd_chk[1].Rfd_State_Fail;
							}
							else
							{
								tx[12] = (((Module_Info.gfd_chk[1].R_GFD_v / 1000) >> 0) & 0xff); // Gfd Resistor
								tx[13] = (((Module_Info.gfd_chk[1].R_GFD_v / 1000) >> 8) & 0xff);

								tx[14] = ((Module_Info.SMR2_Relay_V >> 0) & 0xff);
								tx[15] = ((Module_Info.SMR2_Relay_V >> 8) & 0xff);
								tx[17] = Module_Info.gfd_chk[1].Rfd_State;
							}

							tx[16] = Module_Info.gfd_chk[1].bResult_Gfd;

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[18] = chksum;

							break;
						case PROTOCOL_MESSAGE_QUERY_INPUT_GPIO_STATUS:
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_INPUT_GPIO_STATUS;
							tx[4] = 1;
							tx[5] = 0;
							tx[6] = Module_Info.Gpio_status.All;

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[7] = chksum;

							break;
						case PROTOCOL_MESSAGE_QUERY_SN:
							tx_len = 27;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_SN;
							tx[4] = 0x14;
							tx[5] = 0x00;

							memcpy(&tx[6], Module_Info.SN, 20);
							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[26] = chksum;

							break;

						case PROTOCOL_MESSAGE_QUERY_ALARM_CODE:
							tx_len = 13;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_ALARM_CODE;
							tx[4] = 6;
							tx[5] = 0;
							// === Data ===
							tx[6] = 0;
							tx[7] = 0;
							tx[8] = 0;
							tx[9] = (Module_Info.Alarm_CSU.All) & 0xff;
							tx[10] = (Module_Info.Alarm_CSU.All >> 8) & 0xff;
							tx[11] = 0;

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[12] = chksum;
							break;
						case PROTOCOL_MESSAGE_QUERY_SELF_TEST_STATUS:
							tx_len = 13;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_SELF_TEST_STATUS;
							tx[4] = 6;
							tx[5] = 0;
							tx[6] = sf_t.SF_Config.SF_test_status;
							tx[7] = sf_t.SF_Config.data.value & 0xff;
							tx[8] = (sf_t.SF_Config.data.value >> 8) & 0xff;
							tx[9] = (sf_t.SF_Config.data.value >> 16) & 0xff;
							tx[10] = (sf_t.SF_Config.data.value >> 24) & 0xff;
							tx[11] = (sf_t.SF_Config.data.value >> 32) & 0xff;

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[6 + idx];
							}
							tx[12] = chksum;
							break;

						case PROTOCOL_MESSAGE_QUERY_PARAMETER:
							tx_len = 11;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_QUERY_PARAMETER;
							tx[4] = 4;
							tx[5] = 0;

							tx[6] = uart_rx_buffer[6];
							tx[7] = uart_rx_buffer[7];

							// === Data ===

							switch (uart_rx_buffer[6])
							{
							case Input_L1_AC_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1: // METER_DATA , MCU_DATA
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[0][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[0][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[1][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[1][METER_DATA] >> 8) & 0xff;
									break;
								case 3:
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[2][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[2][METER_DATA] >> 8) & 0xff;
									break;
								default:
									tx[8] = 0;
									tx[9] = 0;
									break;
								}
								break;
							case Input_L2_AC_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[3][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[3][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[4][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[4][METER_DATA] >> 8) & 0xff;
									break;
								case 3:
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[5][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[5][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;
							case Input_L3_AC_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[6][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[6][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[7][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[7][METER_DATA] >> 8) & 0xff;
									break;
								case 3:
									tx[8] = Module_Info.memory.Module_Config.data.item.Correction_Volt[8][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.Correction_Volt[8][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;
							case SMR1_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[0][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[0][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[1][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[1][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;
							case SMR2_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[2][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[2][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[3][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[3][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;
							case SMR3_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[4][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[4][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[5][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[5][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;	
							case SMR4_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[6][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[6][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[7][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[7][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;		
							case SMR5_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[8][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[8][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[9][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[9][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;			
							case SMR6_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[10][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[10][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[11][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[11][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;				
							case GFD_Resister_Left:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[0][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[0][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[1][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[1][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;
							case GFD_Resister_Right:
								switch (uart_rx_buffer[7])
								{
								case 1:
									tx[8] = Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[2][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[2][METER_DATA] >> 8) & 0xff;
									break;
								case 2:
									tx[8] = Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[3][METER_DATA] & 0xff;
									tx[9] = (Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[3][METER_DATA] >> 8) & 0xff;
									break;
								default:
									break;
								}
								break;							
							default:
								break;
							}

							for (int idx = 0; idx < (tx[4] | (tx[5] << 8)); idx++)
							{
								chksum ^= tx[(6 + idx)];
							}
							tx[10] = chksum;
							break;

						/*--------------------------------------------
							Config message
						--------------------------------------------*/
						case PROTOCOL_MESSAGE_CONFIG_MODEL_NAME:
							nGun = 0;
							for (int i = 7; i <= 9; i++)
							{
								if (uart_rx_buffer[(6 + i)] != '0')
									nGun += 1;
							}
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_CONFIG_MODEL_NAME;
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x01;
							tx[7] = 0x01;
							break;

						case PROTOCOL_MESSAGE_CONFIG_OUTPUT_RELAY_OUTPUT:						
							Module_Info.Relay_IO.All = (((uint64_t)uart_rx_buffer[12] << 48) | ((uint64_t)uart_rx_buffer[11] << 40) | ((uint64_t)uart_rx_buffer[10]<< 32) |
														((uint64_t)uart_rx_buffer[9] << 24) | ((uint64_t)uart_rx_buffer[8] << 16) | ((uint64_t)uart_rx_buffer[7]<< 8)	| 
														((uint64_t)uart_rx_buffer[6] )) ;
							tx_len = 8;		
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = uart_rx_buffer[3];
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x01;
							tx[7] = 0x01;
							OpFlag.bRelay_Config_Change = ON;
							break;
							
						case PROTOCOL_MESSAGE_CONFIG_BRIDGE_RELAY_OUTPUT:
							Module_Info.Relay_IO.All = (((uint64_t)uart_rx_buffer[11] << 40) | ((uint64_t)uart_rx_buffer[10] << 32) | ((uint64_t)uart_rx_buffer[9]<< 24) |
														((uint64_t)uart_rx_buffer[8] << 16)  | ((uint64_t)uart_rx_buffer[7] << 8)   | ((uint64_t)uart_rx_buffer[6])); 														
							tx_len = 8;		
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = uart_rx_buffer[3];
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x01;
							tx[7] = 0x01;
							OpFlag.bRelay_Config_Change = ON;
							break;	
						case PROTOCOL_MESSAGE_CONFIG_GPIO_OUTPUT:
							Module_Info.Gpio_status.All = uart_rx_buffer[6];
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_CONFIG_GPIO_OUTPUT;
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x01;
							tx[7] = 0x01;

							break;
						case PROTOCOL_MESSAGE_CONFIG_SN:
							for (int idx = 0; idx < ((uart_rx_buffer[4] | uart_rx_buffer[5] << 8) >> 1); idx++)
								Module_Info.SN[idx] = uart_rx_buffer[(idx + 6)];

							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_CONFIG_SN;
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x01;
							tx[7] = 0x01;

							break;
						case PROTOCOL_MESSAGE_CONFIG_GFD_VALUE:
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_CONFIG_GFD_VALUE;
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x01;
							switch (uart_rx_buffer[6])
							{
							case 0: // Left gun
								Module_Info.gfd_chk[0].Csu_State = uart_rx_buffer[7];
								tx[7] = 0x01;
								break;
							case 1: // Right gun
								Module_Info.gfd_chk[1].Csu_State = uart_rx_buffer[7];
								tx[7] = 0x01;
								break;
							default:
								Module_Info.gfd_chk[0].Csu_State = 0;
								Module_Info.gfd_chk[1].Csu_State = 0;
								tx[7] = 0x00;
								break;
							}
							break;
						case PROTOCOL_MESSAGE_CONFIG_RUN_SELF_TEST:
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_CONFIG_RUN_SELF_TEST;
							tx[4] = 1;
							tx[5] = 0;
							tx[6] = sf_t.SF_Config.SF_Act = 1;
							tx[7] = 1;

							sf_t.SF_Config.SF_State = 0;
							sf_t.SF_Config.data.value = 0;
							sf_t.SF_Config.SF_test_status = 2; // Unknow
							break;
						case PROTOCOL_MESSAGE_CONFIG_PARAMETER:
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_CONFIG_PARAMETER;
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x01;

							// Default the result.

							tx[7] = 0x01;
							temp = uart_rx_buffer[8] | (uart_rx_buffer[9] << 8);

							switch (uart_rx_buffer[6])
							{
							case Input_L1_AC_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[0][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[0][MCU_DATA] = adc_value.ADC2_IN0.value / 10;
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[1][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[1][MCU_DATA] = adc_value.ADC2_IN0.value / 10;
									break;
								case 3:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[2][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[2][MCU_DATA] = adc_value.ADC2_IN0.value / 10;
									break;									
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								default:
									break;
								}
								break;
							case Input_L2_AC_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[3][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[3][MCU_DATA] = adc_value.ADC2_IN1.value / 10;
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[4][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[4][MCU_DATA] = adc_value.ADC2_IN1.value / 10;
									break;
								case 3:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[5][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[5][MCU_DATA] = adc_value.ADC2_IN1.value / 10;
									break;
								default:
									break;
								}
								break;
							case Input_L3_AC_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[6][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[6][MCU_DATA] = adc_value.ADC2_IN2.value / 10;
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[7][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[7][MCU_DATA] = adc_value.ADC2_IN2.value / 10;
									break;
								case 3:
									Module_Info.memory.Module_Config.data.item.Correction_Volt[8][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.Correction_Volt[8][MCU_DATA] = adc_value.ADC2_IN2.value / 10;
									break;
								default:
									break;
								}
								break;
								
							case SMR1_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[0][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[0][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN0.value * vsense1 / 10.0);
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[1][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[1][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN0.value * vsense1 / 10.0);
									break;
								// reset coefficient to orginal.
								case 9:		
									Module_Info.DCVcoeff[0].gain_volt = 1;
									Module_Info.DCVcoeff[0].offset_volt = 0;
									break;
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								default:
									break;
								}
								break;
							case SMR2_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[2][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[2][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN2.value * vsense1 / 10.0);
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[3][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[3][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN2.value * vsense1 / 10.0);
									break;
								// reset coefficient to orginal.
								case 9:
									Module_Info.DCVcoeff[1].gain_volt = 1;
									Module_Info.DCVcoeff[1].offset_volt = 0;
									break;
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								default:
									break;
								}
								break;
							case SMR3_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[4][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[4][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN5.value * vsense1 / 10.0);
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[5][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[5][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN5.value * vsense1 / 10.0);
									break;
								// reset coefficient to orginal.
								case 9:
									Module_Info.DCVcoeff[2].gain_volt = 1;
									Module_Info.DCVcoeff[2].offset_volt = 0;
									break;
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								default:
									break;
								}
								break;	
							case SMR4_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[6][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[6][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN6.value * vsense1 / 10.0);
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[7][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[7][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN6.value * vsense1 / 10.0);
									break;
								// reset coefficient to orginal.
								case 9:
									Module_Info.DCVcoeff[3].gain_volt = 1;
									Module_Info.DCVcoeff[3].offset_volt = 0;
									break;
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								default:
									break;
								}
								break;	
							case SMR5_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[8][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[8][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN7.value * vsense1 / 10.0);
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[9][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[9][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN7.value * vsense1 / 10.0);
									break;
								// reset coefficient to orginal.
								case 9:
									Module_Info.DCVcoeff[4].gain_volt = 1;
									Module_Info.DCVcoeff[4].offset_volt = 0;
									break;
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								default:
									break;
								}
								break;	
							case SMR6_output_voltage:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[10][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[10][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN8.value * vsense1 / 10.0);
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[11][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[11][MCU_DATA] = (uint16_t)((double)adc_value.ADC1_IN8.value * vsense1 / 10.0);
									break;
								// reset coefficient to orginal.
								case 9:
									Module_Info.DCVcoeff[5].gain_volt = 1;
									Module_Info.DCVcoeff[5].offset_volt = 0;
									break;
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								default:
									break;
								}
								break;	
							case GFD_Resister_Left:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[0][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[0][MCU_DATA] = Module_Info.gfd_chk[0].R_GFD_v / 100;
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[1][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[1][MCU_DATA] = Module_Info.gfd_chk[0].R_GFD_v / 100;
									break;
								case 9:									
									bGfd_Correct[0] = 1;
									Module_Info.GFDcoeff[0].gain_volt = 1;
									Module_Info.GFDcoeff[0].offset_volt = 0;
									break;
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								case 11:
									bGfd_Correct[0] = 1;
									break;
								default:
									break;
								}
								break;
							case GFD_Resister_Right:
								switch (uart_rx_buffer[7])
								{
								case 1:
									Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[2][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[2][MCU_DATA] = Module_Info.gfd_chk[1].R_GFD_v / 100;
									break;
								case 2:
									Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[3][METER_DATA] = temp;
									Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[3][MCU_DATA] = Module_Info.gfd_chk[1].R_GFD_v / 100;
									break;
								case 9:
									bGfd_Correct[1] = 1;
									Module_Info.GFDcoeff[1].gain_volt = 1;
									Module_Info.GFDcoeff[1].offset_volt = 0;
									break;
								case 10:
									Module_Info.memory.Module_Config.op_bits.read = ON;
									break;
								case 11:
									bGfd_Correct[1] = 1;
									break;
								default:
									break;
								}
								break;		
							case Battery1_input_voltage:
								switch(uart_rx_buffer[7])
								{								
									
									case 1:
										Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[0][METER_DATA] = temp;
										Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[0][MCU_DATA] = (uint16_t) ((double)adc_value.ADC3_IN8.value * vsense1 / 10.0);
										break;
									case 2:
										Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[1][METER_DATA] = temp;
										Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[1][MCU_DATA] = (uint16_t) ((double)adc_value.ADC3_IN8.value * vsense1 / 10.0);
										break;
									// reset coefficient to orginal.
									case 9:		
										Module_Info.DCINcoeff.gain_volt = 1;
										Module_Info.DCINcoeff.offset_volt = 0;
										break;
									case 10:
										Module_Info.memory.Module_Config.op_bits.read = ON;
										break;
									default:
										break;
								}
								break;						
							}
							Module_Info.memory.Module_Config.op_bits.update = ON;
							break;
						/*-----------------------------------------
							Firmware update message
						------------------------------------------*/
						case PROTOCOL_MESSAGE_UPGRADE_START:
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_UPGRADE_START;
							tx[4] = 0x01;
							tx[5] = 0x00;

							// binCRCTarget = (uart_rx_buffer[6] << 24) | (uart_rx_buffer[6] << 16) | (uart_rx_buffer[6] << 8) | (uart_rx_buffer[6] << 0);
							flashdestination = NEW_CODE_ADDRESS;
							if (FLASH_If_Erase(ADDR_FLASH_SECTOR_9, 3) == FLASHIF_OK)
							{
#if defined(DEBUG) || defined(RTOS_STAT)
								// DEBUG_INFO("Firmware transfer start, earase flash success....\n\r");
#endif
								tx[6] = 0x01;
								tx[7] = 0x01;
							}
							else
							{
#if defined(DEBUG) || defined(RTOS_STAT)
// DEBUG_INFO("Firmware transfer start, earase flash fail....\n\r");
#endif
								tx[6] = 0x00;
								tx[7] = 0x00;
							}

							break;
						case PROTOCOL_MESSAGE_UPGRADE_TRANS:
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_UPGRADE_TRANS;
							tx[4] = 0x01;
							tx[5] = 0x00;

							flashdestination = NEW_CODE_ADDRESS + ((uart_rx_buffer[6] << 0) | (uart_rx_buffer[7] << 8) | (uart_rx_buffer[8] << 16) | (uart_rx_buffer[9] << 24));
							if (FLASH_If_Write(flashdestination, (uint32_t *)&uart_rx_buffer[10], ((((uart_rx_buffer[4]) | (uart_rx_buffer[5]) << 8) - 4) >> 2)) == FLASHIF_OK)
							{
#if defined(DEBUG) || defined(RTOS_STAT)
								// DEBUG_INFO("Firmware transfer start address, length:0x%x, %d...Pass\n\r", flashdestination, (((uart_rx_buffer[4]) | (uart_rx_buffer[5])<<8)-4));
#endif
								tx[6] = 0x01;
								tx[7] = 0x01;
							}
							else
							{
#if defined(DEBUG) || defined(RTOS_STAT)
								// DEBUG_INFO("Firmware transfer start address, length:0x%x, %d...Fail\n\r", flashdestination, (((uart_rx_buffer[4]) | (uart_rx_buffer[5])<<8)-4));
#endif
								tx[6] = 0x00;
								tx[7] = 0x00;
							}

							break;
						case PROTOCOL_MESSAGE_UPGRADE_STOP:
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_UPGRADE_STOP;
							tx[4] = 0x01;
							tx[5] = 0x00;

							flash = NEW_CODE_ADDRESS;
							crc32 = HAL_CRC_Calculate(&hcrc, (uint32_t *)flash, ((FLASH_AP_LENGTH - 4) >> 2));
							flash = ((uint32_t)(NEW_CODE_ADDRESS + FLASH_AP_LENGTH - 4));
#if defined(DEBUG) || defined(RTOS_STAT)
							// DEBUG_INFO("Firmware transfer end, AP CRC crc32, flash: 0x%x, 0x%x\r\n", crc32, *((uint32_t *)flash) );
#endif
							if (crc32 == *((uint32_t *)flash))
							{
								if (FLASH_If_Write(UPGRADE_REQ_ADDRESS, (uint32_t *)&endFlag[0], 1) == FLASHIF_OK)
								{
#if defined(DEBUG) || defined(RTOS_STAT)
									// DEBUG_INFO("Firmware Confirm Tag write ok..\n\r");
#endif
									tx[6] = 0x01;
									tx[7] = 0x01;

									HAL_GPIO_WritePin(RS485_DE_GPIO_Port, RS485_DE_Pin, GPIO_PIN_SET);
									osDelay(2);
									HAL_UART_Transmit(&IAP_USART, (uint8_t *)tx, tx_len, 0xffff);
									osDelay(2);
									HAL_GPIO_WritePin(RS485_DE_GPIO_Port, RS485_DE_Pin, GPIO_PIN_RESET);

									osDelay(100);
									NVIC_SystemReset();
								}
								else
								{
#if defined(DEBUG) || defined(RTOS_STAT)
									// DEBUG_INFO("Firmware Confirm Tag write fail...\n\r");
#endif
									tx[6] = 0x00;
									tx[7] = 0x00;
								}
							}
							else
							{
#if defined(DEBUG) || defined(RTOS_STAT)
								// DEBUG_INFO("Firmware crc32 compare fail...\n\r");
#endif
								tx[6] = 0x00;
								tx[7] = 0x00;
							}
							break;

						case PROTOCOL_MESSAGE_UPGRADE_ABOARD:
#if defined(DEBUG) || defined(RTOS_STAT)
							// DEBUG_INFO("Firmware update transfer aboard...\n\r");
#endif

							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = PROTOCOL_MESSAGE_UPGRADE_ABOARD;
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x01;
							tx[7] = 0x01;
							break;

						default:
/* Todo: bin file receive aboard */
#if defined(DEBUG) || defined(RTOS_STAT)
							// DEBUG_INFO("Protocol message unknow...\n\r");
#endif
							tx_len = 8;
							tx[0] = 0xaa;
							tx[1] = PROTOCOL_ADDR;
							tx[2] = uart_rx_buffer[1];
							tx[3] = uart_rx_buffer[3];
							tx[4] = 0x01;
							tx[5] = 0x00;
							tx[6] = 0x00;
							tx[7] = 0x00;

							break;
						}
					}
					else
					{
#if defined(DEBUG) || defined(RTOS_STAT)
						// DEBUG_INFO("Protocol check sum is wrong...\n\r");
#endif
						tx_len = 8;
						tx[0] = 0xaa;
						tx[1] = PROTOCOL_ADDR;
						tx[2] = uart_rx_buffer[1];
						tx[3] = uart_rx_buffer[3];
						tx[4] = 0x01;
						tx[5] = 0x00;
						tx[6] = 0x00;
						tx[7] = 0x00;
					}
					HAL_GPIO_WritePin(RS485_DE_GPIO_Port, RS485_DE_Pin, GPIO_PIN_SET);
					osDelay(2);
					HAL_UART_Transmit(&IAP_USART, (uint8_t *)tx, tx_len, 0xffff);
					osDelay(2);
					HAL_GPIO_WritePin(RS485_DE_GPIO_Port, RS485_DE_Pin, GPIO_PIN_RESET);

					for (int i = 0; i < uart_rx_len; i++)
						uart_rx_buffer[i] = 0;

					uart_rx_len = 0;
				}
				uart_recv_end_flag = 0;						
				HAL_UART_Receive_DMA(&IAP_USART, uart_rx_buffer, UART_BUFFER_SIZE);		
			}
		osDelay(1);
	}
  /* USER CODE END Uart1Task */
}

/* USER CODE BEGIN Header_Adc1Task */
/**
 * @brief Function implementing the adc1Task thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_Adc1Task */
void Adc1Task(void const * argument)
{
  /* USER CODE BEGIN Adc1Task */
	uint16_t i;

	/* Infinite loop */
	for (;;)
	{
		for	(i = 0;i < ADC1_CHANEL_COUNT;i++)
		{
			ADC1_Value[i] = 0;
		}

		for (i = 0; i < (ADC1_CHANEL_COUNT * ADC1_SAMPLE_COUNT);)
		{
			ADC1_Value[0] += ADC1_Buf[i++];
			ADC1_Value[1] += ADC1_Buf[i++];
			ADC1_Value[2] += ADC1_Buf[i++];
			ADC1_Value[3] += ADC1_Buf[i++];
			ADC1_Value[4] += ADC1_Buf[i++];
			ADC1_Value[5] += ADC1_Buf[i++];
			ADC1_Value[6] += ADC1_Buf[i++];
			ADC1_Value[7] += ADC1_Buf[i++];
			ADC1_Value[8] += ADC1_Buf[i++];
		}

		for	(i = 0;i < ADC1_CHANEL_COUNT;i++)
		{
			ADC1_Value[i] /= ADC1_SAMPLE_COUNT;
		}
		

		// Smooth Filter
		adc_filter_move_avg(&adc_value.ADC1_IN0, ADC1_Value[0]);
		adc_filter_move_avg(&adc_value.ADC1_IN1, ADC1_Value[1]);
		adc_filter_move_avg(&adc_value.ADC1_IN2, ADC1_Value[2]);		
		adc_filter_move_avg(&adc_value.ADC1_IN3, ADC1_Value[3]);
		adc_filter_move_avg(&adc_value.ADC1_IN4, ADC1_Value[4]);
		adc_filter_move_avg(&adc_value.ADC1_IN5, ADC1_Value[5]);
		adc_filter_move_avg(&adc_value.ADC1_IN6, ADC1_Value[6]);
		adc_filter_move_avg(&adc_value.ADC1_IN7, ADC1_Value[7]);
		adc_filter_move_avg(&adc_value.ADC1_IN8, ADC1_Value[8]);

		// output result

		Module_Info.SMR1_Relay_V = (uint32_t)(((double)adc_value.ADC1_IN0.value * vsense1 * Module_Info.DCVcoeff[0].gain_volt) + Module_Info.DCVcoeff[0].offset_volt) / 10;
		Module_Info.SMR2_Relay_V = (uint32_t)(((double)adc_value.ADC1_IN2.value * vsense1 * Module_Info.DCVcoeff[1].gain_volt) + Module_Info.DCVcoeff[1].offset_volt) / 10;
		Module_Info.SMR3_Relay_V = (uint32_t)(((double)adc_value.ADC1_IN5.value * vsense1 * Module_Info.DCVcoeff[2].gain_volt) + Module_Info.DCVcoeff[2].offset_volt) / 10;
		Module_Info.SMR4_Relay_V = (uint32_t)(((double)adc_value.ADC1_IN6.value * vsense1 * Module_Info.DCVcoeff[3].gain_volt) + Module_Info.DCVcoeff[3].offset_volt) / 10;
		Module_Info.SMR5_Relay_V = (uint32_t)(((double)adc_value.ADC1_IN7.value * vsense1 * Module_Info.DCVcoeff[4].gain_volt) + Module_Info.DCVcoeff[4].offset_volt) / 10;
		Module_Info.SMR6_Relay_V = (uint32_t)(((double)adc_value.ADC1_IN8.value * vsense1 * Module_Info.DCVcoeff[5].gain_volt) + Module_Info.DCVcoeff[5].offset_volt) / 10;

		
		c_vadc[0] = (float)(adc_value.ADC1_IN1.value * v_div);
		c_vadc[1] = (float)(adc_value.ADC1_IN3.value * v_div);

		Module_Info.SMR1_Relay_C = (uint32_t)(c_vadc[0] * vsense3) / 10;
		Module_Info.SMR2_Relay_C = (uint32_t)(c_vadc[1] * vsense3) / 10;
		//    }

		Module_Info.Vref_165 = (float)(adc_value.ADC1_IN4.value * v_div);
		osDelay(1);
	}
  /* USER CODE END Adc1Task */
}

/* USER CODE BEGIN Header_Adc2Task */
/**
 * @brief Function implementing the adc2Task thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_Adc2Task */
void Adc2Task(void const * argument)
{
  /* USER CODE BEGIN Adc2Task */
	uint16_t i, j;

	/* Infinite loop */
	for (;;)
	{
		// AC_Contactor off, will stop AC Converstion Calcuate.
		// because of AC_Contactor on/off, the AC_Value will be wrong (746v).
		// Sense 3-Phases voltage before AC-Contracor.

		if (bADC2_Done)
		{
			for (i = 0, j = 0; i < (ADC2_CHANEL_COUNT * ADC2_SAMPLE_COUNT); i += ADC2_CHANEL_COUNT)
			{
				L1_ADC_Each_Value[j] = ADC2_Buf[(i + 0)];
				L2_ADC_Each_Value[j] = ADC2_Buf[(i + 1)];
				L3_ADC_Each_Value[j] = ADC2_Buf[(i + 2)];
				j++;
			}

			HAL_ADC_Start_DMA(&hadc2, ADC2_Buf, (ADC2_SAMPLE_COUNT * ADC2_CHANEL_COUNT));

			ADCSineCalculate2(L1_ADC_Each_Value, ADC2_SAMPLE_COUNT, 212, &AC_Sine[0], vsense2, 0);
			ADCSineCalculate2(L2_ADC_Each_Value, ADC2_SAMPLE_COUNT, 212, &AC_Sine[1], vsense2, 1);
			ADCSineCalculate2(L3_ADC_Each_Value, ADC2_SAMPLE_COUNT, 212, &AC_Sine[2], vsense2, 2);

			// smooth filter
			adc_filter_move_avg(&adc_value.ADC2_IN0, AC_Sine[0].Vrms);
			adc_filter_move_avg(&adc_value.ADC2_IN1, AC_Sine[1].Vrms);
			adc_filter_move_avg(&adc_value.ADC2_IN2, AC_Sine[2].Vrms);

			// Patch the AC_GAIN

			for (i = 0; i < 3; i++)
			{
				switch (i)
				{
				case 0:
					AC_Sine[i].Vrms_AVG = acVolCalWithGain((adc_value.ADC2_IN0.value / 10), i);
					break;
				case 1:
					AC_Sine[i].Vrms_AVG = acVolCalWithGain((adc_value.ADC2_IN1.value / 10), i);
					break;
				case 2:
					AC_Sine[i].Vrms_AVG = acVolCalWithGain((adc_value.ADC2_IN2.value / 10), i);
					break;
				default:

					break;
				}
			}

			// worng filiter
			for (i = 0; i < 3; i++)
			{
				if (AC_Sine[i].Vrms_AVG >= 6000)
					AC_Sine[i].Vrms_AVG = 0;
			}

			// Buffer clean
			//        memset(&ADC2_Buf[0], 0x00, ADC2_CHANEL_COUNT * ADC2_SAMPLE_COUNT);
			//        memset(&L1_ADC_Each_Value[0], 0x00, ADC2_SAMPLE_COUNT);
			//        memset(&L2_ADC_Each_Value[0], 0x00, ADC2_SAMPLE_COUNT);
			//        memset(&L3_ADC_Each_Value[0], 0x00, ADC2_SAMPLE_COUNT);

			// DMA restart
			bADC2_Done = OFF;
		}
		osDelay(1);
	}
  /* USER CODE END Adc2Task */
}

/* USER CODE BEGIN Header_Adc3Task */
/**
 * @brief Function implementing the adc3Task thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_Adc3Task */
void Adc3Task(void const * argument)
{
  /* USER CODE BEGIN Adc3Task */
	/* Infinite loop */

	//   Fail   : <= 100ohm * 950v = 95K ohm
	//  Warning : <= 475K ohm & > 95K ohm
	//   Pass   : > 500ohm * 950v = 475K ohm

	for (;;)
	{
		float temp[2], Vref_165_Offset[2];
		uint16_t i;	

		for (i = 0, ADC3_Value[0] = 0, ADC3_Value[1] = 0; i < (ADC3_CHANEL_COUNT * ADC3_SAMPLE_COUNT);)
		{
			ADC3_Value[0] += ADC3_Buf[i++];
			ADC3_Value[1] += ADC3_Buf[i++];		
			ADC3_Value[2] += ADC3_Buf[i++];			
		}	
		ADC3_Value[2] /= ADC3_SAMPLE_COUNT;    

		// Smooth Filter
		adc_filter_move_avg(&adc_value.ADC3_IN8, ADC3_Value[2]);
    
		Module_Info.BAT_Voltage = (uint32_t) (((double)adc_value.ADC3_IN8.value * vsense1
    		* Module_Info.DCINcoeff.gain_volt) + Module_Info.DCINcoeff.offset_volt) / 10; 

		if ((Module_Info.gfd_chk[0].Csu_State > 0) || (bGfd_Correct[0] == 1))
		{
			ADC3_Value[0] /= 100;

			Module_Info.SMR_Gfd_Sense[0] = (float)ADC3_Value[0] * v_div;

			if (Module_Info.SMR_Gfd_Sense[0] >= GFD_SENSE_CENTER_VOLTAGE)
				temp[0] = Module_Info.SMR_Gfd_Sense[0] - GFD_SENSE_CENTER_VOLTAGE;
			else
				temp[0] = GFD_SENSE_CENTER_VOLTAGE - Module_Info.SMR_Gfd_Sense[0];			
		
				Vref_165_Offset[0] = Module_Info.Vref_165 - GFD_SENSE_CENTER_VOLTAGE;			
			
			temp[0] -= Vref_165_Offset[0];			
			Module_Info.SMR_Gfd_Diff[0] = temp[0];

			temp5 = Vref_165_Offset[0];
			temp6 = temp[0];

			if (Module_Info.SMR1_Relay_V > 100) //  > 10v
			{				
				Module_Info.gfd_chk[0].R_GFD = (uint32_t)((double)Module_Info.SMR1_Relay_V / 10.0 * GFD_RESISTOR_COEFFICIENT / temp[0]) - 50018;
				
				// 21-06-04 Henry
				if (Module_Info.gfd_chk[0].R_GFD > 1000000)
					Module_Info.gfd_chk[0].R_GFD = 1000000;
				
				nGfd_Temp[0][(nGfd_Idx[0]++)] = (uint32_t)((double)Module_Info.gfd_chk[0].R_GFD * Module_Info.GFDcoeff[0].gain_volt);
				nGfd_Temp[0][nGfd_Idx[0]] = (uint32_t)(((double)nGfd_Temp[0][nGfd_Idx[0]])+(Module_Info.GFDcoeff[0].offset_volt * 100.0));
			}
			else
				Module_Info.gfd_chk[0].R_GFD_v = Module_Info.gfd_chk[0].R_GFD = 0;

			R_GFD_Total[0] = 0;
			for (int j = 0; j < GFD_FILTER_LIMIT; j++)
			{
				R_GFD_Total[0] += nGfd_Temp[0][j];
			}

			Module_Info.gfd_chk[0].R_GFD_v = R_GFD_Total[0] / GFD_FILTER_LIMIT;
			if (nGfd_Idx[0] > (GFD_FILTER_LIMIT - 1))
				nGfd_Idx[0] = 0;
		}

		if ((Module_Info.gfd_chk[1].Csu_State > 0) || (bGfd_Correct[1] == 1))
		{
			ADC3_Value[1] /= 100;

			Module_Info.SMR_Gfd_Sense[1] = (float)ADC3_Value[1] * v_div;

			if (Module_Info.SMR_Gfd_Sense[1] >= GFD_SENSE_CENTER_VOLTAGE)
				temp[1] = Module_Info.SMR_Gfd_Sense[1] - GFD_SENSE_CENTER_VOLTAGE;
			else
				temp[1] = GFD_SENSE_CENTER_VOLTAGE - Module_Info.SMR_Gfd_Sense[1];
			
		
			Vref_165_Offset[1] =Vref_165_Offset[0];
			temp[1] -= Vref_165_Offset[1];
			Module_Info.SMR_Gfd_Diff[1] = temp[1];

			if (Module_Info.SMR2_Relay_V > 100) // > 10v
			{
				Module_Info.gfd_chk[1].R_GFD = (uint32_t)((double)Module_Info.SMR2_Relay_V / 10.0 * GFD_RESISTOR_COEFFICIENT / temp[1]) - 50018;

				// 21-06-04 Henry
				if (Module_Info.gfd_chk[1].R_GFD > 1000000)
					Module_Info.gfd_chk[1].R_GFD = 1000000;		
				
				nGfd_Temp[1][(nGfd_Idx[1]++)] = (uint32_t)((double)Module_Info.gfd_chk[1].R_GFD * Module_Info.GFDcoeff[1].gain_volt);
				nGfd_Temp[1][nGfd_Idx[1]] = (uint32_t)(((double)nGfd_Temp[1][nGfd_Idx[1]])+(Module_Info.GFDcoeff[1].offset_volt * 100.0));		
			}
			else
				Module_Info.gfd_chk[1].R_GFD_v = Module_Info.gfd_chk[1].R_GFD = 0;

			R_GFD_Total[1] = 0;
			for (int j = 0; j < GFD_FILTER_LIMIT; j++)
			{
				R_GFD_Total[1] += nGfd_Temp[1][j];
			}

			Module_Info.gfd_chk[1].R_GFD_v = R_GFD_Total[1] / GFD_FILTER_LIMIT;
			if (nGfd_Idx[1] > (GFD_FILTER_LIMIT -1))
				nGfd_Idx[1] = 0;
		}
		osDelay(1);
	}
  /* USER CODE END Adc3Task */
}

/* USER CODE BEGIN Header_GpioTask */
/**
 * @brief Function implementing the gpioTask thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_GpioTask */
void GpioTask(void const * argument)
{
  /* USER CODE BEGIN GpioTask */
	/* Infinite loop */
	for (;;)
	{
		HAL_IWDG_Refresh(&hiwdg);	

	#if 0
	// Output test
		IOdebug();	
	#endif				
	
		if (OpFlag.bRelay_Config_Change == ON)
		{
			OpFlag.bRelay_Config_Change = OFF;
			
			// =================( SMR1_Relay_n  )=======================			
			if (Module_Info.Relay_IO.flags.SMR1_relay_n == ON){
				if (!Exti.EXTI_SMR1_Flag || (Exti.EXTI_SMR1_Flag && EXTI_SMR1_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR1_Flag = false;
					EXTI_SMR1_Count= 0;	

					HAL_GPIO_WritePin(SMR1_RLY_n_Enable_GPIO_Port, SMR1_RLY_n_Enable_Pin, GPIO_PIN_SET);
					//printf(" 1N ON\r\n");	
					
					if(!RelayStatus.SMR1_relay_n)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR1_relay_n = true;
					}
				}else if(Exti.EXTI_SMR1_Flag && EXTI_SMR1_Count < WeldingCMDDelay){	//Reset count				
						EXTI_SMR1_Count = 0;						
				}	
				
					
			}
			else{
				HAL_GPIO_WritePin(SMR1_RLY_n_Enable_GPIO_Port, SMR1_RLY_n_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR1_relay_n = false;
			}

			// =================( SMR1_Relay_p  )=======================			
			if (Module_Info.Relay_IO.flags.SMR1_relay_p == ON){
				if (!Exti.EXTI_SMR1_Flag || (Exti.EXTI_SMR1_Flag && EXTI_SMR1_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR1_Flag = false;
					EXTI_SMR1_Count= 0;	
					HAL_GPIO_WritePin(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, GPIO_PIN_SET);
					//printf(" 1P ON\r\n");	

					if(!RelayStatus.SMR1_relay_p)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR1_relay_p = true;
					} 
				}else if(Exti.EXTI_SMR1_Flag && EXTI_SMR1_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR1_Count = 0;
				}		
			}
			else
			{
				HAL_GPIO_WritePin(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR1_relay_p = false;
			}
			// =================( SMR2_Relay_n  )=======================			
			if (Module_Info.Relay_IO.flags.SMR2_relay_n == ON){
				if (!Exti.EXTI_SMR2_Flag || (Exti.EXTI_SMR2_Flag && EXTI_SMR2_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR2_Flag = false;
					EXTI_SMR2_Count= 0;	
					HAL_GPIO_WritePin(SMR2_RLY_n_Enable_GPIO_Port, SMR2_RLY_n_Enable_Pin, GPIO_PIN_SET);
					//printf(" 2N ON\r\n");

					if(!RelayStatus.SMR2_relay_n)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR2_relay_n = true;
					}
				}else if(Exti.EXTI_SMR2_Flag && EXTI_SMR2_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR2_Count = 0;
				}		
			}
			else
			{
				HAL_GPIO_WritePin(SMR2_RLY_n_Enable_GPIO_Port, SMR2_RLY_n_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR2_relay_n = false;
			}

			// =================( SMR2_Relay_p  )=======================			
			if (Module_Info.Relay_IO.flags.SMR2_relay_p == ON){
				if (!Exti.EXTI_SMR2_Flag || (Exti.EXTI_SMR2_Flag && EXTI_SMR2_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR2_Flag = false;
					EXTI_SMR2_Count= 0;	
					HAL_GPIO_WritePin(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, GPIO_PIN_SET);
					//printf(" 2P ON\r\n");
					
					if(!RelayStatus.SMR2_relay_p)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR2_relay_p = true;
					}
				}else if(Exti.EXTI_SMR2_Flag && EXTI_SMR2_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR2_Count = 0;
				}			
			}
			else
			{
				HAL_GPIO_WritePin(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR2_relay_p = false;
			}
			// =================( SMR3_Relay_n  )=======================			
			if (Module_Info.Relay_IO.flags.SMR3_relay_n == ON){
				if (!Exti.EXTI_SMR3_Flag || (Exti.EXTI_SMR3_Flag && EXTI_SMR3_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR3_Flag = false;
					EXTI_SMR3_Count= 0;	
					HAL_GPIO_WritePin(SMR3_RLY_n_Enable_GPIO_Port, SMR3_RLY_n_Enable_Pin, GPIO_PIN_SET);
					//printf(" 3N ON\r\n");

					if(!RelayStatus.SMR3_relay_n)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR3_relay_n = true;
					}
				}else if(Exti.EXTI_SMR3_Flag && EXTI_SMR3_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR3_Count = 0;
				}			
			}
			else
			{
				HAL_GPIO_WritePin(SMR3_RLY_n_Enable_GPIO_Port, SMR3_RLY_n_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR3_relay_n = false;
			}

			// =================( SMR3_Relay_p  )=======================			
			if (Module_Info.Relay_IO.flags.SMR3_relay_p == ON){
				if (!Exti.EXTI_SMR3_Flag || (Exti.EXTI_SMR3_Flag && EXTI_SMR3_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR3_Flag = false;
					EXTI_SMR3_Count= 0;	
					HAL_GPIO_WritePin(SMR3_RLY_p_Enable_GPIO_Port, SMR3_RLY_p_Enable_Pin, GPIO_PIN_SET);
					//printf(" 3P ON\r\n");

					if(!RelayStatus.SMR3_relay_p)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR3_relay_p = true;
					}
				}else if(Exti.EXTI_SMR3_Flag && EXTI_SMR3_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR3_Count = 0;
				}		
			}
			else
			{
				HAL_GPIO_WritePin(SMR3_RLY_p_Enable_GPIO_Port, SMR3_RLY_p_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR3_relay_p = false;
			}
			// =================( SMR4_Relay_n  )=======================			
			if (Module_Info.Relay_IO.flags.SMR4_relay_n == ON){
				if (!Exti.EXTI_SMR4_Flag || (Exti.EXTI_SMR4_Flag && EXTI_SMR4_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR4_Flag = false;
					EXTI_SMR4_Count= 0;	
					HAL_GPIO_WritePin(SMR4_RLY_n_Enable_GPIO_Port, SMR4_RLY_n_Enable_Pin, GPIO_PIN_SET);
					//printf(" 4N ON\r\n");

					if(!RelayStatus.SMR4_relay_n)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR4_relay_n = true;
					}
				}else if(Exti.EXTI_SMR4_Flag && EXTI_SMR4_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR4_Count = 0;
				}		
			}
			else
			{
				HAL_GPIO_WritePin(SMR4_RLY_n_Enable_GPIO_Port, SMR4_RLY_n_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR4_relay_n = false;
			}

			// =================( SMR4_Relay_p  )=======================			
			if (Module_Info.Relay_IO.flags.SMR4_relay_p == ON){
				if (!Exti.EXTI_SMR4_Flag || (Exti.EXTI_SMR4_Flag && EXTI_SMR4_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR4_Flag = false;
					EXTI_SMR4_Count= 0;	
					HAL_GPIO_WritePin(SMR4_RLY_p_Enable_GPIO_Port, SMR4_RLY_p_Enable_Pin, GPIO_PIN_SET);
					//printf(" 4P ON\r\n");

					if(!RelayStatus.SMR4_relay_p)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR4_relay_p = true;
					}
				}else if(Exti.EXTI_SMR4_Flag && EXTI_SMR4_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR4_Count = 0;
				}		
			}
			else
			{
				HAL_GPIO_WritePin(SMR4_RLY_p_Enable_GPIO_Port, SMR4_RLY_p_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR4_relay_p = false;
			}
			// =================( SMR5_Relay_n  )=======================			
			if (Module_Info.Relay_IO.flags.SMR5_relay_n == ON){
				if (!Exti.EXTI_SMR5_Flag || (Exti.EXTI_SMR5_Flag && EXTI_SMR5_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR5_Flag = false;
					EXTI_SMR5_Count= 0;	
					HAL_GPIO_WritePin(SMR5_RLY_n_Enable_GPIO_Port, SMR5_RLY_n_Enable_Pin, GPIO_PIN_SET);
					//printf(" 5N ON\r\n");

					if(!RelayStatus.SMR5_relay_n)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR5_relay_n = true;
					}
				}else if(Exti.EXTI_SMR5_Flag && EXTI_SMR5_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR5_Count = 0;
				}		
			}
			else
			{
				HAL_GPIO_WritePin(SMR5_RLY_n_Enable_GPIO_Port, SMR5_RLY_n_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR5_relay_n = false;
			}

			// =================( SMR5_Relay_p  )=======================			
			if (Module_Info.Relay_IO.flags.SMR5_relay_p == ON){
				if (!Exti.EXTI_SMR5_Flag || (Exti.EXTI_SMR5_Flag && EXTI_SMR5_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR5_Flag = false;
					EXTI_SMR5_Count= 0;	
					HAL_GPIO_WritePin(SMR5_RLY_p_Enable_GPIO_Port, SMR5_RLY_p_Enable_Pin, GPIO_PIN_SET);
					//printf(" 5P ON\r\n");

					if(!RelayStatus.SMR5_relay_p)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR5_relay_p = true;
					}
				}else if(Exti.EXTI_SMR5_Flag && EXTI_SMR5_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR5_Count = 0;
				}		
			}
			else
			{
				HAL_GPIO_WritePin(SMR5_RLY_p_Enable_GPIO_Port, SMR5_RLY_p_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR5_relay_p = false;
			}
			// =================( SMR6_Relay_n  )=======================			
			if (Module_Info.Relay_IO.flags.SMR6_relay_n == ON){
				if (!Exti.EXTI_SMR6_Flag || (Exti.EXTI_SMR6_Flag && EXTI_SMR6_Count >= WeldingCMDDelay)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR6_Flag = false;
					EXTI_SMR6_Count= 0;	
					HAL_GPIO_WritePin(SMR6_RLY_n_Enable_GPIO_Port, SMR6_RLY_n_Enable_Pin, GPIO_PIN_SET);
					//printf(" 6N ON\r\n");

					if(!RelayStatus.SMR6_relay_n)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR6_relay_n = true;
					}
				}else if(Exti.EXTI_SMR6_Flag && EXTI_SMR6_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR6_Count = 0;
				}	
			}
			else
			{
				HAL_GPIO_WritePin(SMR6_RLY_n_Enable_GPIO_Port, SMR6_RLY_n_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR6_relay_n = false;
			}

			// =================( SMR6_Relay_p  )=======================			
			if (Module_Info.Relay_IO.flags.SMR6_relay_p == ON){
				if (!Exti.EXTI_SMR6_Flag || (Exti.EXTI_SMR6_Flag && EXTI_SMR6_Count >=10)){	//ignore DCM relay command 1s when Relay welding 
					Exti.EXTI_SMR6_Flag = false;
					EXTI_SMR6_Count= 0;	
					HAL_GPIO_WritePin(SMR6_RLY_p_Enable_GPIO_Port, SMR6_RLY_p_Enable_Pin, GPIO_PIN_SET);
					//printf(" 6P ON\r\n");

					if(!RelayStatus.SMR6_relay_p)
					{				
						osDelay(Multi_Relay_Delay_Time);		
						RelayStatus.SMR6_relay_p = true;
					}
				}else if(Exti.EXTI_SMR6_Flag && EXTI_SMR6_Count < WeldingCMDDelay){	//Reset count
						EXTI_SMR6_Count = 0;
				}	
			}
			else
			{
				HAL_GPIO_WritePin(SMR6_RLY_p_Enable_GPIO_Port, SMR6_RLY_p_Enable_Pin, GPIO_PIN_RESET);
				RelayStatus.SMR6_relay_p = false;
			}
		// =================( Precharge1 )==============================
			if (Module_Info.Relay_IO.flags.Precharge1 == ON)
			{
				HAL_GPIO_WritePin(Precharge1_Enable_GPIO_Port, Precharge1_Enable_Pin, GPIO_PIN_SET);
			}
			else
			{
				HAL_GPIO_WritePin(Precharge1_Enable_GPIO_Port, Precharge1_Enable_Pin, GPIO_PIN_RESET);
			}	
		// =================( Precharge2 )==============================
			if (Module_Info.Relay_IO.flags.Precharge2 == ON)
			{
				HAL_GPIO_WritePin(Precharge2_Enable_GPIO_Port, Precharge2_Enable_Pin, GPIO_PIN_SET);
			}
			else
			{
				HAL_GPIO_WritePin(Precharge2_Enable_GPIO_Port, Precharge2_Enable_Pin, GPIO_PIN_RESET);
			}		
		// =================( AC_Contactor  )=======================
			if (Module_Info.Relay_IO.flags.AC_Contactor == ON)
			{
				HAL_GPIO_WritePin(Contactor_Enable_GPIO_Port, Contactor_Enable_Pin, GPIO_PIN_SET);
			}
			else
			{
				HAL_GPIO_WritePin(Contactor_Enable_GPIO_Port, Contactor_Enable_Pin, GPIO_PIN_RESET);
			}
		}
		osDelay(1);
	}
  /* USER CODE END GpioTask */
}

/* USER CODE BEGIN Header_MemoryTask */
/**
 * @brief Function implementing the memoryTask thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_MemoryTask */
void MemoryTask(void const * argument)
{
  /* USER CODE BEGIN MemoryTask */
	Module_Info.memory.Module_Config.op_bits.read = ON;
	__IO uint32_t flash;
	int i;

	/* Infinite loop */
	for (;;)
	{
		/*
			Charger config operation
		*/
		if (Module_Info.memory.Module_Config.op_bits.read) // Memory read
		{
			// Read data from block
			// for(uint16_t idx=0; idx<(MEMORY_LENGTH_CONFIG>>2); idx++)
			GainCaliFlag = true;

			for (uint16_t idx = 0; idx < MEM_REAL_LENGTH; idx++)
			{
				flash = ADDR_FLASH_SECTOR_4 + (idx * 4);
				Module_Info.memory.Module_Config.data.value[idx] = *(uint32_t *)flash;

				if ((Module_Info.memory.Module_Config.data.value[idx] == 0xffffffff) ||
					(Module_Info.memory.Module_Config.data.value[idx] == 0))
				{
					if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3)
						break;
					else
						GainCaliFlag = false;
					Module_Info.memory.Module_Config.data.value[idx] = mem_def_data[idx];
				}				
			}

			// coefficient DATA
			
			for (i = 0; i < DC_CORRECT_GAIN_MAX_NUM; i++)
			{
				if (Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[i*2][MCU_DATA] >
					Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[(i*2 + 1)][MCU_DATA]) // Make sure memory have calibration valid value
				{
					CLC_Corr_Gain_Par(Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[i*2][METER_DATA],
									  Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[(i*2 + 1)][METER_DATA],
									  Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[i*2][MCU_DATA],
									  Module_Info.memory.Module_Config.data.item.DC_Correction_Volt[(i*2 + 1)][MCU_DATA],
									  &Module_Info.DCVcoeff[i].gain_volt, &Module_Info.DCVcoeff[i].offset_volt);
				}
				else
				{
					Module_Info.DCVcoeff[i].gain_volt = 1;
					Module_Info.DCVcoeff[i].offset_volt = 0;
				}
			}	

			for (i = 0; i < GFD_CORRECT_GAIN_MAX_NUM; i++)
			{
				if (Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[i*2][MCU_DATA] >
					Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[(i*2 + 1)][MCU_DATA])
				{
					CLC_Corr_Gain_Par(Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[i*2][METER_DATA],
									  Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[(i*2 + 1)][METER_DATA],
									  Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[i*2][MCU_DATA],
									  Module_Info.memory.Module_Config.data.item.GFD_Correction_Resistor[(i*2 + 1)][MCU_DATA],
									  &Module_Info.GFDcoeff[i].gain_volt, &Module_Info.GFDcoeff[i].offset_volt);
				}
				else
				{
					Module_Info.GFDcoeff[i].gain_volt = 1;
					Module_Info.GFDcoeff[i].offset_volt = 0;
				}
			}	
        
		
			if( Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[0][MCU_DATA] >  
				Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[(1)][MCU_DATA] )  
			{ 
				CLC_Corr_Gain_Par( Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[0][METER_DATA], 
								Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[(1)][METER_DATA], 
								Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[0][MCU_DATA], 
								Module_Info.memory.Module_Config.data.item.DCIn_Correction_Volt[(1)][MCU_DATA], 
								&Module_Info.DCINcoeff.gain_volt, &Module_Info.DCINcoeff.offset_volt);
			}
			else
			{            
				Module_Info.DCINcoeff.gain_volt = 1;
				Module_Info.DCINcoeff.offset_volt = 0;                        
			}			

			
			Module_Info.memory.Module_Config.op_bits.read = OFF;
			// DEBUG_INFO("Read MEM_ADDR_EVSE_CONFIG block(4k byte) pass.\r\n");
			
  			//  Module_Info.memory.Module_Config.op_bits.update = 1;

			//  for (uint16_t idx = 0; idx < MEM_REAL_LENGTH; idx++)
			//  {
			//  	Module_Info.memory.Module_Config.data.value[idx] = 0;
			//  }	
					          
		}

		if (Module_Info.memory.Module_Config.op_bits.update) // Memory update
		{
			// Erase block data
			if (FLASH_If_Erase(ADDR_FLASH_SECTOR_4, 1) == FLASHIF_OK)
			{
#ifdef DEBUG
// DEBUG_INFO("Erase MEM_ADDR_EVSE_CONFIG block(4k bytes) pass.\r\n");
#endif
				// Write data to block

				if (FLASH_If_Write(ADDR_FLASH_SECTOR_4, (uint32_t *)Module_Info.memory.Module_Config.data.value, MEMORY_LENGTH_CONFIG >> 2) == FLASHIF_OK)
				{
					// DEBUG_INFO("Write MEM_ADDR_EVSE_CONFIG block(4k bytes) pass.\r\n");
				}
				else
				{
					// DEBUG_INFO("Write MEM_ADDR_EVSE_CONFIG block(4k bytes) fail.\r\n");
				}

				Module_Info.memory.Module_Config.op_bits.update = OFF;
			}
			else
			{
				// DEBUG_INFO("Erase MEM_ADDR_EVSE_CONFIG block(4k bytes) fail.\r\n");
			}
		}

		if (Module_Info.memory.Module_Config.op_bits.clear) // Memory clear
		{
			// Erase block data
			if (FLASH_If_Erase(ADDR_FLASH_SECTOR_4, 1) == FLASHIF_OK)
			{
				// DEBUG_INFO("Erase MEM_ADDR_EVSE_CONFIG block(4k byte) pass.\r\n");

				Module_Info.memory.Module_Config.op_bits.clear = OFF;
			}
			else
			{
				// DEBUG_INFO("Erase MEM_ADDR_EVSE_CONFIG block(4k byte) fail.\r\n");
			}
		}

		osDelay(1);
	}
  /* USER CODE END MemoryTask */
}

/* USER CODE BEGIN Header_Inkey_Task */
/**
 * @brief Function implementing the InkeyTask thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_Inkey_Task */
void Inkey_Task(void const * argument)
{
  /* USER CODE BEGIN Inkey_Task */
	/* Infinite loop */
	for (;;)
	{
		//  	if( (AC_Sine[0].Vrms_AVG < 1600) ||
		//  		(AC_Sine[1].Vrms_AVG < 1600) ||
		//  		(AC_Sine[2].Vrms_AVG < 1600) )
		//  	{
		//  		if(Counter.nAC_Drop > 10)
		//  			HAL_GPIO_WritePin(CSU_IO_HIGH_GPIO_Port, CSU_IO_HIGH_Pin, GPIO_PIN_RESET);
		//        else
		//            Counter.nAC_Drop++;
		//  	}
		//  	else
		//  	{
		//  		Counter.nAC_Drop = 0;
		//  		HAL_GPIO_WritePin(CSU_IO_HIGH_GPIO_Port, CSU_IO_HIGH_Pin, GPIO_PIN_SET);
		//  	}

		// InterLock bit Detect ....
		//  	if(HAL_GPIO_ReadPin(Relay_Interlock_GPIO_Port, Relay_Interlock_Pin) == 1)
		//  	{
		//  		Counter.nInterLock++;
		//  		if(Counter.nInterLock >5)
		//  			OpFlag.bInterLock = ON;
		//  	}
		//  	else
		//  	{
		//  		Counter.nInterLock = OpFlag.bInterLock = OFF;
		//  	}
		//
		//  	if( OpFlag.bInterLock == ON )
		//  	{
		//  		OpFlag.bInterLock= OFF;
		//
		//  		HAL_GPIO_WritePin(Parallel_RLY_n_Enable_GPIO_Port, Parallel_RLY_n_Enable_Pin, GPIO_PIN_RESET);
		//  		HAL_GPIO_WritePin(Parallel_RLY_p_Enable_GPIO_Port, Parallel_RLY_p_Enable_Pin, GPIO_PIN_RESET);
		//		HAL_GPIO_WritePin(SMR1_RLY_n_Enable_GPIO_Port, SMR1_RLY_n_Enable_Pin, GPIO_PIN_RESET);
		//		HAL_GPIO_WritePin(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, GPIO_PIN_RESET);
		//		HAL_GPIO_WritePin(SMR2_RLY_n_Enable_GPIO_Port, SMR2_RLY_n_Enable_Pin, GPIO_PIN_RESET);
		//		HAL_GPIO_WritePin(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, GPIO_PIN_RESET);
		//		HAL_GPIO_WritePin(Contactor_Enable_GPIO_Port, Contactor_Enable_Pin, GPIO_PIN_RESET);
		//		HAL_GPIO_WritePin(Precharge_Enable_GPIO_Port, Precharge_Enable_Pin, GPIO_PIN_RESET);
		//
		//		osDelay(10);
		//  	}
		//
		osDelay(1);
	}
  /* USER CODE END Inkey_Task */
}

/* USER CODE BEGIN Header_Gfd_Left_Task */
/**
 * @brief Function implementing the gfd_left_Task thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_Gfd_Left_Task */
void Gfd_Left_Task(void const * argument)
{
  /* USER CODE BEGIN Gfd_Left_Task */
	/* Infinite loop */

	//   Fail   : <= 100ohm * 950v = 95K ohm
	//  Warning : <= 475K ohm & > 95K ohm
	//   Pass   : > 500ohm * 950v = 475K ohm

	for (;;)
	{
		uint16_t _delay, temp2;				
			
			switch (Module_Info.gfd_chk[0].Csu_State)
			{
			case 0: // idle
				_delay = 1000;

				if (bGfd_Correct[0] == 0)
				{
					Module_Info.gfd_chk[0].bResult_Gfd = GFD_UNKNOW;
					Module_Info.gfd_chk[0].Rfd_State = 0;
					Module_Info.gfd_chk[0].bFirstGfd = 1;

					HAL_GPIO_WritePin(Drv_Up_GPIO_Port, Drv_Up_Pin, GPIO_PIN_RESET);
					HAL_GPIO_WritePin(Drv_Down_GPIO_Port, Drv_Down_Pin, GPIO_PIN_RESET);
					HAL_GPIO_WritePin(Sys1_Self_Test_DC_p_GPIO_Port, Sys1_Self_Test_DC_p_Pin, GPIO_PIN_RESET);
					HAL_GPIO_WritePin(Sys1_Self_Test_DC_n_GPIO_Port, Sys1_Self_Test_DC_n_Pin, GPIO_PIN_RESET);					
				}
				else
				{
					HAL_GPIO_WritePin(Drv_Up_GPIO_Port, Drv_Up_Pin, GPIO_PIN_SET);
					HAL_GPIO_WritePin(Drv_Down_GPIO_Port, Drv_Down_Pin, GPIO_PIN_SET);	
				}
				break;

			case 1: // Cable check  -- 500v

				switch (Module_Info.gfd_chk[0].Rfd_State)
				{
				case 0:
					// *********  On Up-Down Bridge
					_delay = WAIT_FOR_RESISTER_CALC;

					if (Module_Info.gfd_chk[0].bResult_Gfd == GFD_UNKNOW)
					{
						HAL_GPIO_WritePin(Drv_Up_GPIO_Port, Drv_Up_Pin, GPIO_PIN_SET);
						HAL_GPIO_WritePin(Drv_Down_GPIO_Port, Drv_Down_Pin, GPIO_PIN_SET);

						// 20.04.23
						if (Module_Info.gfd_chk[0].bFirstGfd == 1)
						{
							Module_Info.gfd_chk[0].Gfd_Running_Count = 0;
							Module_Info.gfd_chk[0].Gfd_Warning_Count = 0;
							Module_Info.gfd_chk[0].Rfd_State = 2;
						}
						else
							Module_Info.gfd_chk[0].Rfd_State++;
					}
					break;

				case 1:
					_delay = WAIT_FOR_RESISTER_CALC_LONG;

					if (!((Module_Info.SMR_Gfd_Sense[0] > GFD_SENSE_VOLTAGE_DOWN_LIMIT) && (Module_Info.SMR_Gfd_Sense[0] < GFD_SENSE_VOLTAGE_UP_LIMIT) && (Module_Info.SMR1_Relay_V < GFD_WORKING_VOLTAGE)))
					{
#if (GFD_SELF_TEST == 1)
						Module_Info.gfd_chk[0].Rfd_State++;
						Module_Info.gfd_chk[0].Gfd_Running_Count = 0;

						// Self_Test_1_DC+
						HAL_GPIO_WritePin(Sys1_Self_Test_DC_p_GPIO_Port, Sys1_Self_Test_DC_p_Pin, GPIO_PIN_SET);
#else
						HAL_GPIO_WritePin(Sys1_Self_Test_DC_p_GPIO_Port, Sys1_Self_Test_DC_p_Pin, GPIO_PIN_RESET);
						HAL_GPIO_WritePin(Sys1_Self_Test_DC_n_GPIO_Port, Sys1_Self_Test_DC_n_Pin, GPIO_PIN_RESET);

						Module_Info.gfd_chk[0].Gfd_Running_Count = 0;
						Module_Info.gfd_chk[0].Gfd_Warning_Count = 0;

						Module_Info.gfd_chk[0].Rfd_State = 5;
#endif
					}
					else // Not Match to Ground Test condiction.
					{
						Module_Info.gfd_chk[0].R_GFD = 1000000; // 1000K Ohm
						Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = OFF;

						Module_Info.gfd_chk[0].Rfd_State = 0;
					}
					break;

				case 2:
					_delay = 10;

					// begin isolation test ....Self_test_1
					// SMR1_Relay_V >= 200v (2000)
					// Isolation Test Voltage is 500v

					if (Module_Info.SMR1_Relay_V >= ISOLATION_TEST_VOLTAGE)
						temp2 = Module_Info.SMR1_Relay_V - ISOLATION_TEST_VOLTAGE;
					else
						temp2 = ISOLATION_TEST_VOLTAGE - Module_Info.SMR1_Relay_V;
					if (temp2 < LINE_VOLTAGE_TOLERANCE) // ABS(10V)
					{
						Module_Info.gfd_chk[0].Gfd_Running_Count++;
						if (Module_Info.gfd_chk[0].Gfd_Running_Count > 4)
						{
							if (Module_Info.gfd_chk[0].bFirstGfd == 1)
							{
								Module_Info.gfd_chk[0].Rfd_State = 5;
							}
							else
							{
								Module_Info.gfd_chk[0].Rfd_State++;
							}

							Module_Info.gfd_chk[0].Gfd_Running_Count = 0;
						}
					}
					else
					{
						Module_Info.gfd_chk[0].Rfd_State = 0;
					}
					break;
				case 3:
					_delay = WAIT_FOR_RESISTER_CALC_LONG;
					if (Module_Info.gfd_chk[0].R_GFD_v <= GFD_SELF_TEST_RESISTOR)
					{
						// Self_Test_1_DC-
						HAL_GPIO_WritePin(Sys1_Self_Test_DC_p_GPIO_Port, Sys1_Self_Test_DC_p_Pin, GPIO_PIN_RESET);
						HAL_GPIO_WritePin(Sys1_Self_Test_DC_n_GPIO_Port, Sys1_Self_Test_DC_n_Pin, GPIO_PIN_SET);

						Module_Info.gfd_chk[0].Rfd_State++;
						Module_Info.gfd_chk[0].Gfd_Running_Count = 0;
					}
					else
					{
						// Need to many tims then gfd fail.

						Module_Info.gfd_chk[0].Gfd_Running_Count++;
						if (Module_Info.gfd_chk[0].Gfd_Running_Count > 4)
						{
							Module_Info.gfd_chk[0].bResult_Gfd = GFD_FAIL;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = ON;

							// 20.03.30  henry
							Module_Info.gfd_chk[0].R_GFD_Fail = Module_Info.gfd_chk[0].R_GFD_v;
							Module_Info.gfd_chk[0].Rfd_State_Fail = Module_Info.gfd_chk[0].Rfd_State;
							Module_Info.gfd_chk[0].SMR_Voltage_Fail = Module_Info.SMR1_Relay_V;

							Module_Info.gfd_chk[0].Rfd_State = 0;
						}
					}
					break;
				case 4:
					_delay = WAIT_FOR_RESISTER_CALC;
					if (Module_Info.gfd_chk[0].R_GFD_v <= GFD_SELF_TEST_RESISTOR)
					{
						HAL_GPIO_WritePin(Sys1_Self_Test_DC_n_GPIO_Port, Sys1_Self_Test_DC_n_Pin, GPIO_PIN_RESET);

						Module_Info.gfd_chk[0].Rfd_State++;
						Module_Info.gfd_chk[0].Gfd_Running_Count = 0;
						Module_Info.gfd_chk[0].Gfd_Warning_Count = 0;
					}
					else
					{
						// Need to many tims then gfd fail.

						Module_Info.gfd_chk[0].Gfd_Running_Count++;
						if (Module_Info.gfd_chk[0].Gfd_Running_Count > 4)
						{
							Module_Info.gfd_chk[0].bResult_Gfd = GFD_FAIL;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = ON;

							// 20.03.30  henry
							Module_Info.gfd_chk[0].R_GFD_Fail = Module_Info.gfd_chk[0].R_GFD_v;
							Module_Info.gfd_chk[0].Rfd_State_Fail = Module_Info.gfd_chk[0].Rfd_State;
							Module_Info.gfd_chk[0].SMR_Voltage_Fail = Module_Info.SMR1_Relay_V;

							Module_Info.gfd_chk[0].Rfd_State = 0;
						}
					}
					break;
				case 5:
					_delay = WAIT_FOR_RESISTER_CALC;

					if (Module_Info.gfd_chk[0].R_GFD_v <= ((GFD_RESISTOR_WARNING * EVSE_MAX_OUTPUT_VOLTAGE) + GFD_EXTRA_FAIL_RESISTOR))
					{
						if (Module_Info.SMR1_Relay_V >= GFD_WORKING_VOLTAGE)
						{
							Module_Info.gfd_chk[0].Gfd_Running_Count++;
							Module_Info.gfd_chk[0].Gfd_Warning_Count = 0;
						}

						if (Module_Info.gfd_chk[0].Gfd_Running_Count > GFD_TEST_TIMES)
						{
							Module_Info.gfd_chk[0].bResult_Gfd = GFD_FAIL;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = ON;

							// 20.03.30  henry
							Module_Info.gfd_chk[0].R_GFD_Fail = Module_Info.gfd_chk[0].R_GFD_v;
							Module_Info.gfd_chk[0].Rfd_State_Fail = Module_Info.gfd_chk[0].Rfd_State;
							Module_Info.gfd_chk[0].SMR_Voltage_Fail = Module_Info.SMR1_Relay_V;

							Module_Info.gfd_chk[0].Rfd_State = 0;
						}
					}
					else
					{
						if ((Module_Info.gfd_chk[0].R_GFD_v <= (GFD_RESISTOR_PRE_WARNING * EVSE_MAX_OUTPUT_VOLTAGE)) && (Module_Info.gfd_chk[0].R_GFD_v > ((GFD_RESISTOR_WARNING * EVSE_MAX_OUTPUT_VOLTAGE) + GFD_EXTRA_FAIL_RESISTOR)))
						{
							// 21.09.30  GFD action on above 200v
							if (Module_Info.SMR1_Relay_V >= GFD_WORKING_VOLTAGE)
							{
								Module_Info.gfd_chk[0].Gfd_Running_Count = 0;
								Module_Info.gfd_chk[0].Gfd_Warning_Count++;
							}

							if (Module_Info.gfd_chk[0].Gfd_Warning_Count > GFD_TEST_TIMES)
							{
								// 20.04.23  henry
								if (Module_Info.gfd_chk[0].bFirstGfd == 1)
								{
									// Gfd = Fail.
									Module_Info.gfd_chk[0].bFirstGfd = 0;

									Module_Info.gfd_chk[0].bResult_Gfd = GFD_WARNING;
									Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = ON;

									// 20.06.18 Vern , don't do Self_test
									Module_Info.gfd_chk[0].Rfd_State++;

									// 20.03.30  henry
									//  								Module_Info.gfd_chk[0].R_GFD_Fail = Module_Info.gfd_chk[0].R_GFD_v;
									//  								Module_Info.gfd_chk[0].Rfd_State_Fail 	= Module_Info.gfd_chk[0].Rfd_State;
									//  								Module_Info.gfd_chk[0].SMR_Voltage_Fail = Module_Info.SMR1_Relay_V;
									//
									//  								Module_Info.gfd_chk[0].Rfd_State = 0;
								}
								else
								{
									Module_Info.gfd_chk[0].bResult_Gfd = GFD_WARNING;
									Module_Info.gfd_chk[0].Rfd_State++; // 20.03.30 henry
								}
							}
						}
						else
						{
							// Gfd = Pass.
							if (Module_Info.gfd_chk[0].bFirstGfd == 1)
							{
								Module_Info.gfd_chk[0].bFirstGfd = 0;
								Module_Info.gfd_chk[0].bResult_Gfd = GFD_UNKNOW;

								Module_Info.gfd_chk[0].Rfd_State = 1;
							}
							else
							{
								Module_Info.gfd_chk[0].bResult_Gfd = GFD_PASS;
								Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = OFF;

								Module_Info.gfd_chk[0].Rfd_State++; // 20.03.30 henry
							}
						}
					}
					break;
				default:
					if ((Module_Info.gfd_chk[0].bResult_Gfd == GFD_UNKNOW) || (Module_Info.gfd_chk[0].bResult_Gfd == GFD_FAIL))
					{
						Module_Info.gfd_chk[0].Rfd_State = 0;
					}
					else
					{
						Module_Info.gfd_chk[0].Rfd_State = 10;
						Module_Info.gfd_chk[0].Csu_State = 2;
					}
					break;
				}
				break;
			case 2:
			case 3:
				switch (Module_Info.gfd_chk[0].Rfd_State)
				{
				case 10:
					// *********  On Up-Down Bridge
					_delay = 1;

					//  				HAL_GPIO_WritePin(Drv_Up_GPIO_Port, Drv_Up_Pin, GPIO_PIN_SET);
					//  				HAL_GPIO_WritePin(Drv_Down_GPIO_Port, Drv_Down_Pin, GPIO_PIN_SET);

					Module_Info.gfd_chk[0].Rfd_State++;
					break;

				case 11:
					_delay = WAIT_FOR_RESISTER_CALC_FAST;

					if (!((Module_Info.SMR_Gfd_Sense[0] > GFD_SENSE_VOLTAGE_DOWN_LIMIT) && (Module_Info.SMR_Gfd_Sense[0] < GFD_SENSE_VOLTAGE_UP_LIMIT) && (Module_Info.SMR1_Relay_V < GFD_WORKING_VOLTAGE)))
					{
						Module_Info.gfd_chk[0].Rfd_State++;
						Module_Info.gfd_chk[0].Gfd_Running_Count = 0;
						Module_Info.gfd_chk[0].Gfd_Warning_Count = 0;
					}
					else // Not Match to Ground Test condiction.
					{
						Module_Info.gfd_chk[0].R_GFD = 1000000; // 1000K Ohm
						Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = OFF;

						Module_Info.gfd_chk[0].Rfd_State = 10;
					}
					break;
				case 12:
					_delay = WAIT_FOR_RESISTER_CALC_FAST;

					if (Module_Info.gfd_chk[0].R_GFD_v <= ((GFD_RESISTOR_WARNING * EVSE_MAX_OUTPUT_VOLTAGE) + GFD_EXTRA_FAIL_RESISTOR))
					{
						if (Module_Info.SMR1_Relay_V >= GFD_WORKING_VOLTAGE)
						{
							Module_Info.gfd_chk[0].Gfd_Warning_Count = 0;
							Module_Info.gfd_chk[0].Gfd_Running_Count++;
						}

						if (Module_Info.gfd_chk[0].Gfd_Running_Count > GFD_TEST_TIMES)
						{
							Module_Info.gfd_chk[0].bResult_Gfd = GFD_FAIL;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = ON;

							// 20.03.30  henry
							Module_Info.gfd_chk[0].R_GFD_Fail = Module_Info.gfd_chk[0].R_GFD_v;
							Module_Info.gfd_chk[0].Rfd_State_Fail = Module_Info.gfd_chk[0].Rfd_State;
							Module_Info.gfd_chk[0].SMR_Voltage_Fail = Module_Info.SMR1_Relay_V;

							Module_Info.gfd_chk[0].Rfd_State = 0;
						}
					}
					else
					{
						if ((Module_Info.gfd_chk[0].R_GFD_v <= (GFD_RESISTOR_PRE_WARNING * EVSE_MAX_OUTPUT_VOLTAGE)) && (Module_Info.gfd_chk[0].R_GFD_v > ((GFD_RESISTOR_WARNING * EVSE_MAX_OUTPUT_VOLTAGE) + GFD_EXTRA_FAIL_RESISTOR)))
						{
							// 21.09.30  GFD action on above 200v
							if (Module_Info.SMR1_Relay_V >= GFD_WORKING_VOLTAGE)
							{
								Module_Info.gfd_chk[0].Gfd_Running_Count = 0;
								Module_Info.gfd_chk[0].Gfd_Warning_Count++;
							}

							if (Module_Info.gfd_chk[0].Gfd_Warning_Count > GFD_TEST_TIMES)
							{
								Module_Info.gfd_chk[0].bResult_Gfd = GFD_WARNING;
								Module_Info.gfd_chk[0].Rfd_State++;
							}
						}
						else
						{
							Module_Info.gfd_chk[0].bResult_Gfd = GFD_PASS;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_0 = OFF;
							Module_Info.gfd_chk[0].Rfd_State++;
						}
					}
					break;
				default:
					if (Module_Info.gfd_chk[0].bResult_Gfd != GFD_FAIL)
						Module_Info.gfd_chk[0].Rfd_State = 10;
					break;
				}
				break;
			default:

				break;
			}

			if (Module_Info.gfd_chk[0].bResult_Gfd == GFD_FAIL)
			{
				_delay = 100;				
				HAL_GPIO_WritePin(SMR1_RLY_n_Enable_GPIO_Port, SMR1_RLY_n_Enable_Pin, GPIO_PIN_RESET);
				HAL_GPIO_WritePin(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, GPIO_PIN_RESET);	
				bRelayFeedback = 1;
			}
			vTaskDelay(_delay / portTICK_RATE_MS);		
	}
  /* USER CODE END Gfd_Left_Task */
}

/* USER CODE BEGIN Header_Gfd_Right_Task */
/**
 * @brief Function implementing the gfd_right_Task thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_Gfd_Right_Task */
void Gfd_Right_Task(void const * argument)
{
  /* USER CODE BEGIN Gfd_Right_Task */
	/* Infinite loop */

	//   Fail   : <= 100ohm * 950v = 95K ohm
	//  Warning : <= 475K ohm & > 95K ohm
	//   Pass   : > 500ohm * 950v = 475K

	for (;;)
	{
		uint16_t _delay, temp2;		
			
			switch (Module_Info.gfd_chk[1].Csu_State)
			{
			case 0: // idle
				_delay = 1000;

				if (bGfd_Correct[1] == 0)
				{
					Module_Info.gfd_chk[1].bResult_Gfd = GFD_UNKNOW;
					Module_Info.gfd_chk[1].Rfd_State = 0;
					Module_Info.gfd_chk[1].bFirstGfd = 1;

					HAL_GPIO_WritePin(Drv_Up_2_GPIO_Port, Drv_Up_2_Pin, GPIO_PIN_RESET);
					HAL_GPIO_WritePin(Drv_Down_2_GPIO_Port, Drv_Down_2_Pin, GPIO_PIN_RESET);
					HAL_GPIO_WritePin(Sys2_Self_Test_DC_p_GPIO_Port, Sys2_Self_Test_DC_p_Pin, GPIO_PIN_RESET);
					HAL_GPIO_WritePin(Sys2_Self_Test_DC_n_GPIO_Port, Sys2_Self_Test_DC_n_Pin, GPIO_PIN_RESET);										
				}
				else
				{
					HAL_GPIO_WritePin(Drv_Up_2_GPIO_Port, Drv_Up_2_Pin, GPIO_PIN_SET);
					HAL_GPIO_WritePin(Drv_Down_2_GPIO_Port, Drv_Down_2_Pin, GPIO_PIN_SET);											
				}
				break;

			case 1: // Cable check  -- 500v

				switch (Module_Info.gfd_chk[1].Rfd_State)
				{
				case 0:
					// *********  On Up-Down Bridge
					_delay = WAIT_FOR_RESISTER_CALC;

					if (Module_Info.gfd_chk[1].bResult_Gfd == GFD_UNKNOW)
					{
						HAL_GPIO_WritePin(Drv_Up_2_GPIO_Port, Drv_Up_2_Pin, GPIO_PIN_SET);
						HAL_GPIO_WritePin(Drv_Down_2_GPIO_Port, Drv_Down_2_Pin, GPIO_PIN_SET);

						// 20.04.23
						if (Module_Info.gfd_chk[1].bFirstGfd == 1)
						{
							Module_Info.gfd_chk[1].Gfd_Running_Count = 0;
							Module_Info.gfd_chk[1].Gfd_Warning_Count = 0;
							Module_Info.gfd_chk[1].Rfd_State = 2;
						}
						else
							Module_Info.gfd_chk[1].Rfd_State++;
					}
					break;

				case 1:
					_delay = WAIT_FOR_RESISTER_CALC_LONG;

					if (!((Module_Info.SMR_Gfd_Sense[1] > GFD_SENSE_VOLTAGE_DOWN_LIMIT) && (Module_Info.SMR_Gfd_Sense[1] < GFD_SENSE_VOLTAGE_UP_LIMIT) && (Module_Info.SMR2_Relay_V < GFD_WORKING_VOLTAGE)))
					{
#if (GFD_SELF_TEST == 1)
						Module_Info.gfd_chk[1].Rfd_State++;
						Module_Info.gfd_chk[1].Gfd_Running_Count = 0;

						// Self_Test_2_DC+
						HAL_GPIO_WritePin(Sys2_Self_Test_DC_p_GPIO_Port, Sys2_Self_Test_DC_p_Pin, GPIO_PIN_SET);
#else
						HAL_GPIO_WritePin(Sys2_Self_Test_DC_p_GPIO_Port, Sys2_Self_Test_DC_p_Pin, GPIO_PIN_RESET);
						HAL_GPIO_WritePin(Sys2_Self_Test_DC_n_GPIO_Port, Sys2_Self_Test_DC_n_Pin, GPIO_PIN_RESET);

						Module_Info.gfd_chk[1].Gfd_Running_Count = 0;
						Module_Info.gfd_chk[1].Gfd_Warning_Count = 0;

						Module_Info.gfd_chk[1].Rfd_State = 5;
#endif
					}
					else // Not Match to Ground Test condiction.
					{
						Module_Info.gfd_chk[1].R_GFD = 1000000; // 1000K Ohm
						Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = OFF;

						Module_Info.gfd_chk[1].Rfd_State = 0;
					}
					break;

				case 2:
					_delay = 10;

					// begin isolation test ....Self_test_1
					// SMR1_Relay_V >= 200v (2000)
					// Isolation Test Voltage is 500v

					if (Module_Info.SMR2_Relay_V >= ISOLATION_TEST_VOLTAGE)
						temp2 = Module_Info.SMR2_Relay_V - ISOLATION_TEST_VOLTAGE;
					else
						temp2 = ISOLATION_TEST_VOLTAGE - Module_Info.SMR2_Relay_V;
					if (temp2 < LINE_VOLTAGE_TOLERANCE) // ABS(10V)
					{
						Module_Info.gfd_chk[1].Gfd_Running_Count++;
						if (Module_Info.gfd_chk[1].Gfd_Running_Count > 4)
						{
							if (Module_Info.gfd_chk[1].bFirstGfd == 1)
							{
								Module_Info.gfd_chk[1].Rfd_State = 5;
							}
							else
							{
								Module_Info.gfd_chk[1].Rfd_State++;
							}
							Module_Info.gfd_chk[1].Gfd_Running_Count = 0;
						}
					}
					else
					{
						Module_Info.gfd_chk[1].Rfd_State = 0;
					}
					break;
				case 3:
					_delay = WAIT_FOR_RESISTER_CALC_LONG;
					if (Module_Info.gfd_chk[1].R_GFD_v <= GFD_SELF_TEST_RESISTOR)
					{
						// Self_Test_2_DC-
						HAL_GPIO_WritePin(Sys2_Self_Test_DC_p_GPIO_Port, Sys2_Self_Test_DC_p_Pin, GPIO_PIN_RESET);
						HAL_GPIO_WritePin(Sys2_Self_Test_DC_n_GPIO_Port, Sys2_Self_Test_DC_n_Pin, GPIO_PIN_SET);

						Module_Info.gfd_chk[1].Rfd_State++;
						Module_Info.gfd_chk[1].Gfd_Running_Count = 0;
					}
					else
					{
						Module_Info.gfd_chk[1].Gfd_Running_Count++;

						if (Module_Info.gfd_chk[1].Gfd_Running_Count > 4)
						{
							Module_Info.gfd_chk[1].bResult_Gfd = GFD_FAIL;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = ON;

							// 20.03.30  henry
							Module_Info.gfd_chk[1].R_GFD_Fail = Module_Info.gfd_chk[1].R_GFD_v;
							Module_Info.gfd_chk[1].Rfd_State_Fail = Module_Info.gfd_chk[1].Rfd_State;
							Module_Info.gfd_chk[1].SMR_Voltage_Fail = Module_Info.SMR2_Relay_V;

							Module_Info.gfd_chk[1].Rfd_State = 0;
						}
					}
					break;
				case 4:
					_delay = WAIT_FOR_RESISTER_CALC;
					if (Module_Info.gfd_chk[1].R_GFD_v <= GFD_SELF_TEST_RESISTOR)
					{
						HAL_GPIO_WritePin(Sys2_Self_Test_DC_n_GPIO_Port, Sys2_Self_Test_DC_n_Pin, GPIO_PIN_RESET);

						Module_Info.gfd_chk[1].Rfd_State++;
						Module_Info.gfd_chk[1].Gfd_Running_Count = 0;
						Module_Info.gfd_chk[1].Gfd_Warning_Count = 0;
					}
					else
					{
						// Need to many tims then gfd fail.

						Module_Info.gfd_chk[1].Gfd_Running_Count++;

						if (Module_Info.gfd_chk[1].Gfd_Running_Count > 4)
						{
							Module_Info.gfd_chk[1].bResult_Gfd = GFD_FAIL;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = ON;

							// 20.03.30  henry
							Module_Info.gfd_chk[1].R_GFD_Fail = Module_Info.gfd_chk[1].R_GFD_v;
							Module_Info.gfd_chk[1].Rfd_State_Fail = Module_Info.gfd_chk[1].Rfd_State;
							Module_Info.gfd_chk[1].SMR_Voltage_Fail = Module_Info.SMR2_Relay_V;

							Module_Info.gfd_chk[1].Rfd_State = 0;
						}
					}
					break;
				case 5:
					_delay = WAIT_FOR_RESISTER_CALC;

					if (Module_Info.gfd_chk[1].R_GFD_v <= ((GFD_RESISTOR_WARNING * EVSE_MAX_OUTPUT_VOLTAGE) + GFD_EXTRA_FAIL_RESISTOR))
					{
						if (Module_Info.SMR2_Relay_V >= GFD_WORKING_VOLTAGE)
						{
							Module_Info.gfd_chk[1].Gfd_Running_Count++;
							Module_Info.gfd_chk[1].Gfd_Warning_Count = 0;
						}

						if (Module_Info.gfd_chk[1].Gfd_Running_Count > GFD_TEST_TIMES)
						{
							Module_Info.gfd_chk[1].bResult_Gfd = GFD_FAIL;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = ON;

							// 20.03.30  henry
							Module_Info.gfd_chk[1].R_GFD_Fail = Module_Info.gfd_chk[1].R_GFD_v;
							Module_Info.gfd_chk[1].Rfd_State_Fail = Module_Info.gfd_chk[1].Rfd_State;
							Module_Info.gfd_chk[1].SMR_Voltage_Fail = Module_Info.SMR2_Relay_V;

							Module_Info.gfd_chk[1].Rfd_State = 0;
						}
					}
					else
					{
						if ((Module_Info.gfd_chk[1].R_GFD_v <= (GFD_RESISTOR_PRE_WARNING * EVSE_MAX_OUTPUT_VOLTAGE)) && (Module_Info.gfd_chk[1].R_GFD_v > ((GFD_RESISTOR_WARNING * EVSE_MAX_OUTPUT_VOLTAGE) + GFD_EXTRA_FAIL_RESISTOR)))
						{
							// 21.09.30  GFD action on above 200v
							if (Module_Info.SMR2_Relay_V >= GFD_WORKING_VOLTAGE)
							{
								Module_Info.gfd_chk[1].Gfd_Running_Count = 0;
								Module_Info.gfd_chk[1].Gfd_Warning_Count++;
							}

							if (Module_Info.gfd_chk[1].Gfd_Warning_Count > GFD_TEST_TIMES)
							{
								// 20.04.23 henry
								if (Module_Info.gfd_chk[1].bFirstGfd == 1)
								{
									// Gfd = Fail.
									Module_Info.gfd_chk[1].bFirstGfd = 0;

									Module_Info.gfd_chk[1].bResult_Gfd = GFD_WARNING;
									Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = ON;

									// 20.06.18 Vern Get Warning, don't do Self_test
									Module_Info.gfd_chk[1].Rfd_State++;

									// 20.03.30  henry
									//  								Module_Info.gfd_chk[1].R_GFD_Fail = Module_Info.gfd_chk[1].R_GFD_v;
									//  								Module_Info.gfd_chk[1].Rfd_State_Fail 	= Module_Info.gfd_chk[1].Rfd_State;
									//  								Module_Info.gfd_chk[1].SMR_Voltage_Fail = Module_Info.SMR2_Relay_V;
									//
									//  								Module_Info.gfd_chk[1].Rfd_State = 0;
								}
								else
								{
									Module_Info.gfd_chk[1].bResult_Gfd = GFD_WARNING;
									Module_Info.gfd_chk[1].Rfd_State++; // 20.03.30 henry
								}
							}
						}
						else
						{
							// Gfd = Pass.
							if (Module_Info.gfd_chk[1].bFirstGfd == 1)
							{
								Module_Info.gfd_chk[1].bFirstGfd = 0;
								Module_Info.gfd_chk[1].bResult_Gfd = GFD_UNKNOW;

								Module_Info.gfd_chk[1].Rfd_State = 1;
							}
							else
							{
								Module_Info.gfd_chk[1].bResult_Gfd = GFD_PASS;
								Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = OFF;

								Module_Info.gfd_chk[1].Rfd_State++; // 20.03.30 henry
							}
						}
					}
					break;
				default:
					if ((Module_Info.gfd_chk[1].bResult_Gfd == GFD_UNKNOW) || (Module_Info.gfd_chk[1].bResult_Gfd == GFD_FAIL))
					{
						Module_Info.gfd_chk[1].Rfd_State = 0;
					}
					else
					{
						Module_Info.gfd_chk[1].Rfd_State = 10;
					}
					break;
				}
				break;
			case 2:
			case 3:
				switch (Module_Info.gfd_chk[1].Rfd_State)
				{
				case 10:
					// *********  On Up-Down Bridge
					_delay = 1;
					Module_Info.gfd_chk[1].Rfd_State++;

					break;

				case 11:
					_delay = WAIT_FOR_RESISTER_CALC_FAST;

					if (!((Module_Info.SMR_Gfd_Sense[1] > GFD_SENSE_VOLTAGE_DOWN_LIMIT) && (Module_Info.SMR_Gfd_Sense[1] < GFD_SENSE_CENTER_VOLTAGE) && (Module_Info.SMR2_Relay_V < GFD_WORKING_VOLTAGE)))
					{
						Module_Info.gfd_chk[1].Rfd_State++;
						Module_Info.gfd_chk[1].Gfd_Running_Count = 0;
						Module_Info.gfd_chk[1].Gfd_Warning_Count = 0;
					}
					else // Not Match to Ground Test condiction.
					{
						Module_Info.gfd_chk[1].R_GFD = 1000000; // 1000K Ohm
						Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = OFF;

						Module_Info.gfd_chk[1].Rfd_State = 10;
					}
					break;
				case 12:
					_delay = WAIT_FOR_RESISTER_CALC_FAST;

					if (Module_Info.gfd_chk[1].R_GFD_v <= ((GFD_RESISTOR_WARNING * EVSE_MAX_OUTPUT_VOLTAGE) + GFD_EXTRA_FAIL_RESISTOR))
					{
						if (Module_Info.SMR2_Relay_V >= GFD_WORKING_VOLTAGE)
						{
							Module_Info.gfd_chk[1].Gfd_Warning_Count = 0;
							Module_Info.gfd_chk[1].Gfd_Running_Count++;
						}

						if (Module_Info.gfd_chk[1].Gfd_Running_Count > GFD_TEST_TIMES)
						{
							Module_Info.gfd_chk[1].bResult_Gfd = GFD_FAIL;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = ON;

							// 20.03.30  henry
							Module_Info.gfd_chk[1].R_GFD_Fail = Module_Info.gfd_chk[1].R_GFD_v;
							Module_Info.gfd_chk[1].Rfd_State_Fail = Module_Info.gfd_chk[1].Rfd_State;
							Module_Info.gfd_chk[1].SMR_Voltage_Fail = Module_Info.SMR2_Relay_V;

							Module_Info.gfd_chk[1].Rfd_State = 0;
						}
					}
					else
					{
						if ((Module_Info.gfd_chk[1].R_GFD_v <= (GFD_RESISTOR_PRE_WARNING * EVSE_MAX_OUTPUT_VOLTAGE)) && (Module_Info.gfd_chk[1].R_GFD_v > ((GFD_RESISTOR_WARNING * EVSE_MAX_OUTPUT_VOLTAGE) + GFD_EXTRA_FAIL_RESISTOR)))
						{
							// 21.09.30  GFD action on above 200v
							if (Module_Info.SMR2_Relay_V >= GFD_WORKING_VOLTAGE)
							{
								Module_Info.gfd_chk[1].Gfd_Running_Count = 0;
								Module_Info.gfd_chk[1].Gfd_Warning_Count++;
							}

							if (Module_Info.gfd_chk[1].Gfd_Warning_Count > GFD_TEST_TIMES)
							{
								Module_Info.gfd_chk[1].bResult_Gfd = GFD_WARNING;
								Module_Info.gfd_chk[1].Rfd_State++;
							}
						}
						else
						{
							Module_Info.gfd_chk[1].bResult_Gfd = GFD_PASS;
							Module_Info.Alarm_CSU.flags.Gfd_Alarm_1 = OFF;
							Module_Info.gfd_chk[1].Rfd_State++;
						}
					}
					break;
				default:
					if (Module_Info.gfd_chk[1].bResult_Gfd != GFD_FAIL)
						Module_Info.gfd_chk[1].Rfd_State = 10;
					break;
				}
				break;
			default:

				break;
			}

			if (Module_Info.gfd_chk[1].bResult_Gfd == GFD_FAIL)
			{
				_delay = 100;				
				HAL_GPIO_WritePin(SMR2_RLY_n_Enable_GPIO_Port, SMR2_RLY_n_Enable_Pin, GPIO_PIN_RESET);
				HAL_GPIO_WritePin(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, GPIO_PIN_RESET);
				bRelayFeedback = 1;
			}

			vTaskDelay(_delay / portTICK_RATE_MS);
		
	}
  /* USER CODE END Gfd_Right_Task */
}

/* USER CODE BEGIN Header_SF_Test_Task */
/**
 * @brief Function implementing the sf_test_Task thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_SF_Test_Task */
void SF_Test_Task(void const * argument)
{
  /* USER CODE BEGIN SF_Test_Task */
	/* Infinite loop */
	uint16_t temp;

	for (;;)
	{
		

		// if(temp1){
			// HAL_GPIO_WritePin(Contactor_Enable_GPIO_Port, Contactor_Enable_Pin, GPIO_PIN_SET);
			// HAL_GPIO_WritePin(PSU_Enable1_GPIO_Port, PSU_Enable1_Pin, GPIO_PIN_SET);	
			// HAL_GPIO_WritePin(PSU_Enable2_GPIO_Port, PSU_Enable2_Pin, GPIO_PIN_SET);
			// HAL_GPIO_WritePin(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, GPIO_PIN_SET);
			// HAL_GPIO_WritePin(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, GPIO_PIN_SET);
			// HAL_GPIO_WritePin(SMR3_RLY_p_Enable_GPIO_Port, SMR3_RLY_p_Enable_Pin, GPIO_PIN_SET);				
		// }else{
			// HAL_GPIO_WritePin(Contactor_Enable_GPIO_Port, Contactor_Enable_Pin, GPIO_PIN_RESET);	
			// HAL_GPIO_WritePin(PSU_Enable1_GPIO_Port, PSU_Enable1_Pin, GPIO_PIN_RESET);	
			// HAL_GPIO_WritePin(PSU_Enable2_GPIO_Port, PSU_Enable2_Pin, GPIO_PIN_RESET);	
			
			// HAL_GPIO_WritePin(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, GPIO_PIN_RESET);
			// HAL_GPIO_WritePin(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, GPIO_PIN_RESET);
			// HAL_GPIO_WritePin(SMR3_RLY_p_Enable_GPIO_Port, SMR3_RLY_p_Enable_Pin, GPIO_PIN_RESET);		
		// }

		// if(temp3){			
		// 	HAL_GPIO_WritePin(PSU_Enable2_GPIO_Port, PSU_Enable2_Pin, GPIO_PIN_SET);	
		// }else{			
		// 	HAL_GPIO_WritePin(PSU_Enable2_GPIO_Port, PSU_Enable2_Pin, GPIO_PIN_RESET);		
		// }


		// temp2 = HAL_GPIO_ReadPin(AC_Contactor_Ret_GPIO_Port, AC_Contactor_Ret_Pin);
		// temp2 = HAL_GPIO_ReadPin(SMR1_Relay_p_Ret_GPIO_Port, SMR1_Relay_p_Ret_Pin);
		// temp3 = HAL_GPIO_ReadPin(SMR2_Relay_p_Ret_GPIO_Port, SMR2_Relay_p_Ret_Pin);
		// temp4 = HAL_GPIO_ReadPin(SMR3_Relay_p_Ret_GPIO_Port, SMR3_Relay_p_Ret_Pin);

		if (sf_t.SF_Config.SF_Act)
		{
//Check AC voltage	bit 0 ~ 2
//CheckACVoltage:
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				for (int n = 0; n < 3; n++)
				{
					printf("AC %d:%d\r\n",n,AC_Sine[n].Vrms_AVG);
					if (AC_Sine[n].Vrms_AVG > 2200)
						{temp = AC_Sine[n].Vrms_AVG - 2200;
					}else{
						temp = 2200 - AC_Sine[n].Vrms_AVG;
					}	

					if (temp >= 200){
						sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
					}else{
						sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
					}	
					sf_t.SF_Config.SF_State++;
				}
			}	
	
// Check SMR1_Voltage	bit 3
//CheckSMR1Voltage:			
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				printf("SMR1 V:%d\r\n",Module_Info.SMR1_Relay_V);
				if (Module_Info.SMR1_Relay_V > 1500){
					temp = Module_Info.SMR1_Relay_V - 1500;
				}else{
					temp = 1500 - Module_Info.SMR1_Relay_V;
				}

				if (temp >= 30){
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				}else{
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				}
				sf_t.SF_Config.SF_State++;
			}	

// Check SMR2_Voltage	bit 4
//CheckSMR2Voltage:			
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				printf("SMR2 V:%d\r\n",Module_Info.SMR2_Relay_V);
				if (Module_Info.SMR2_Relay_V > 1500)
					temp = Module_Info.SMR2_Relay_V - 1500;
				else
					temp = 1500 - Module_Info.SMR2_Relay_V;

				if (temp >= 30)
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				else
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);

				sf_t.SF_Config.SF_State++;
			}	
// Check SMR3_Voltage	bit 5
//CheckSMR3Voltage:		
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{	
				printf("SMR3 V:%d\r\n",Module_Info.SMR3_Relay_V);
				if (Module_Info.SMR3_Relay_V > 1500)
					temp = Module_Info.SMR3_Relay_V - 1500;
				else
					temp = 1500 - Module_Info.SMR3_Relay_V;
				if (temp >= 30)
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				else
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);

				sf_t.SF_Config.SF_State++;
			}	
// Check SMR4_Voltage	bit 6
//CheckSMR4Voltage:		
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{	
				printf("SMR4V :%d\r\n",Module_Info.SMR4_Relay_V);
				if (Module_Info.SMR4_Relay_V > 1500)
					temp = Module_Info.SMR4_Relay_V - 1500;
				else
					temp = 1500 - Module_Info.SMR4_Relay_V;
				if (temp >= 30)
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				else
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}	
// Check SMR5_Voltage	bit 7
//CheckSMR5Voltage:			
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				printf("SMR5 V:%d\r\n",Module_Info.SMR5_Relay_V);
				if (Module_Info.SMR5_Relay_V > 1500)
					temp = Module_Info.SMR5_Relay_V - 1500;
				else
					temp = 1500 - Module_Info.SMR5_Relay_V;
				if (temp >= 30)
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				else
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}	
// Check SMR6_Voltage	bit 8
//CheckSMR6Voltage:			
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				printf("SMR6 V:%d\r\n",Module_Info.SMR6_Relay_V);				
				if (Module_Info.SMR6_Relay_V > 1500)
					temp = Module_Info.SMR6_Relay_V - 1500;
				else
					temp = 1500 - Module_Info.SMR6_Relay_V;
				if (temp >= 30)
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				else
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;		
			}		
			// Check SMR6_Voltage	bit 9
//CheckDCInVoltage:			
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				printf("DC In1:%d\r\n",Module_Info.BAT_Voltage);				
				if (Module_Info.BAT_Voltage > 1500)
					temp = Module_Info.BAT_Voltage - 1500;
				else
					temp = 1500 - Module_Info.BAT_Voltage;
				if (temp >= 30)
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				else
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;		
			}																				

//Check IO		bit 10~32
//CheckIO:
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				nTestIO(Contactor_Enable_GPIO_Port, Contactor_Enable_Pin, AC_Contactor_Ret_GPIO_Port, AC_Contactor_Ret_Pin, sf_t.SF_Config.SF_State++);
				}
			
			nTestIO(PSU_Enable1_GPIO_Port, PSU_Enable1_Pin, SMR5_Relay_p_Ret_GPIO_Port, SMR5_Relay_p_Ret_Pin, sf_t.SF_Config.SF_State++);		

			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				nTestIO(PSU_Enable2_GPIO_Port, PSU_Enable2_Pin, AC_Contactor_Ret_GPIO_Port, AC_Contactor_Ret_Pin, sf_t.SF_Config.SF_State++);
			}
			
			nTestIO(SMR1_RLY_n_Enable_GPIO_Port, SMR1_RLY_n_Enable_Pin, SMR1_Relay_n_Ret_GPIO_Port, SMR1_Relay_n_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, SMR1_Relay_p_Ret_GPIO_Port, SMR1_Relay_p_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR2_RLY_n_Enable_GPIO_Port, SMR2_RLY_n_Enable_Pin, SMR2_Relay_n_Ret_GPIO_Port, SMR2_Relay_n_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, SMR2_Relay_p_Ret_GPIO_Port, SMR2_Relay_p_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR3_RLY_n_Enable_GPIO_Port, SMR3_RLY_n_Enable_Pin, SMR3_Relay_n_Ret_GPIO_Port, SMR3_Relay_n_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR3_RLY_p_Enable_GPIO_Port, SMR3_RLY_p_Enable_Pin, SMR3_Relay_p_Ret_GPIO_Port, SMR3_Relay_p_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR4_RLY_n_Enable_GPIO_Port, SMR4_RLY_n_Enable_Pin, SMR4_Relay_n_Ret_GPIO_Port, SMR4_Relay_n_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR4_RLY_p_Enable_GPIO_Port, SMR4_RLY_p_Enable_Pin, SMR4_Relay_p_Ret_GPIO_Port, SMR4_Relay_p_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR5_RLY_n_Enable_GPIO_Port, SMR5_RLY_n_Enable_Pin, SMR5_Relay_n_Ret_GPIO_Port, SMR5_Relay_n_Ret_Pin, sf_t.SF_Config.SF_State++);
			nTestIO(SMR5_RLY_p_Enable_GPIO_Port, SMR5_RLY_p_Enable_Pin, SMR5_Relay_p_Ret_GPIO_Port, SMR5_Relay_p_Ret_Pin, sf_t.SF_Config.SF_State++);
			
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				nTestIO(SMR6_RLY_n_Enable_GPIO_Port, SMR6_RLY_n_Enable_Pin, SMR6_Relay_n_Ret_GPIO_Port, SMR6_Relay_n_Ret_Pin, sf_t.SF_Config.SF_State++);
				nTestIO(SMR6_RLY_p_Enable_GPIO_Port, SMR6_RLY_p_Enable_Pin, SMR6_Relay_p_Ret_GPIO_Port, SMR6_Relay_p_Ret_Pin, sf_t.SF_Config.SF_State++);
				nTestIO(Precharge1_Enable_GPIO_Port, Precharge1_Enable_Pin, Precharge1_Ret_GPIO_Port, Precharge1_Ret_Pin, sf_t.SF_Config.SF_State++);
				nTestIO(Precharge2_Enable_GPIO_Port, Precharge2_Enable_Pin, Precharge2_Ret_GPIO_Port, Precharge2_Ret_Pin, sf_t.SF_Config.SF_State++);	
			}		
			
			nTestEXT_INT(SMR1_RLY_n_Enable_GPIO_Port, SMR1_RLY_n_Enable_Pin, &EXTI_TestFlag1, sf_t.SF_Config.SF_State++);
			nTestEXT_INT(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, &EXTI_TestFlag2, sf_t.SF_Config.SF_State++);			

			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{	
				nTestEXT_INT(SMR2_RLY_n_Enable_GPIO_Port, SMR2_RLY_n_Enable_Pin, &EXTI_TestFlag3, sf_t.SF_Config.SF_State++);
				nTestEXT_INT(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, &EXTI_TestFlag4, sf_t.SF_Config.SF_State++);
				nTestEXT_INT(SMR3_RLY_n_Enable_GPIO_Port, SMR3_RLY_n_Enable_Pin, &EXTI_TestFlag5, sf_t.SF_Config.SF_State++);
				nTestEXT_INT(SMR3_RLY_p_Enable_GPIO_Port, SMR3_RLY_p_Enable_Pin, &EXTI_TestFlag6, sf_t.SF_Config.SF_State++);				
			}	

// Check SMR1_Current	bit 33
//CheckSMR1Current:
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				printf("SMR1 C:%d\r\n",Module_Info.SMR1_Relay_C);
				if (Module_Info.SMR1_Relay_C > 1180)
					temp = Module_Info.SMR1_Relay_C - 1180;
				else
					temp = 1180 - Module_Info.SMR1_Relay_C;

				// In Range( 118A +- 5A )
				if (temp >= 50)
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				else
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}
// Check SMR2_Current	bit 34
//CheckSMR2Current:
			if(nBoard_Addr == MainBridge1 || nBoard_Addr == MainBridge2 || nBoard_Addr == MainBridge3){
				sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}else{
				printf("SMR2 C:%d\r\n",Module_Info.SMR2_Relay_C);
				if (Module_Info.SMR2_Relay_C > 1180)
					temp = Module_Info.SMR2_Relay_C - 1180;
				else
					temp = 1180 - Module_Info.SMR2_Relay_C;

				// In Range( 118A +- 5A )
				if (temp >= 50)
					sf_t.SF_Config.data.value |= ((uint64_t)1 << sf_t.SF_Config.SF_State); // Fail
				else
					sf_t.SF_Config.data.value &= ~((uint64_t)1 << sf_t.SF_Config.SF_State);
				sf_t.SF_Config.SF_State++;
			}	
//CheckFinish:
			sf_t.SF_Config.SF_Act = 0; // Turn Off
			if (sf_t.SF_Config.data.value > 0)
			{
				sf_t.SF_Config.SF_test_status = 0; // Fail
			}
			else
			{
				sf_t.SF_Config.SF_test_status = 1; // Pass
			}
		
		}
		osDelay(1);
	}
  /* USER CODE END SF_Test_Task */
}

/* USER CODE BEGIN Header_LedTask */
/**
 * @brief Function implementing the _ledTask_ thread.
 * @param argument: Not used
 * @retval None
 */
/* USER CODE END Header_LedTask */
void LedTask(void const * argument)
{
  /* USER CODE BEGIN LedTask */
	/* Infinite loop */
	for (;;)
	{		
		if (dir == 0)
		{
			if (pwmVal < 500)
			{
				if (GainCaliFlag)
					pwmVal++;
				else
					pwmVal += 20;
				__HAL_TIM_SetCompare(&htim4, TIM_CHANNEL_2, pwmVal);
			}
			else
			{
				dir = 1;
				if (GainCaliFlag)
					osDelay(400);
				else
					osDelay(100);
			}
		}
		else
		{
			if (pwmVal > 0)
			{
				if (GainCaliFlag)
					pwmVal--;
				else
					pwmVal -= 20;
				__HAL_TIM_SetCompare(&htim4, TIM_CHANNEL_2, pwmVal);
			}
			else
			{
				dir = 0;
				if (GainCaliFlag)
					osDelay(400);
				else
					osDelay(100);
			}
		}
		osDelay(1);
	}
  /* USER CODE END LedTask */
}

/* USER CODE BEGIN Header_canTask */
/**
* @brief Function implementing the CANTask thread.
* @param argument: Not used
* @retval None
*/
/* USER CODE END Header_canTask */
void canTask(void const * argument)
{
  /* USER CODE BEGIN canTask */
  CAN1_sFilterConfig.FilterBank = 0;
  CAN1_sFilterConfig.FilterMode = CAN_FILTERMODE_IDMASK;
  CAN1_sFilterConfig.FilterScale = CAN_FILTERSCALE_32BIT;
//   CAN1_sFilterConfig.FilterIdHigh =(0x0450 << 3) >> 16;
//   CAN1_sFilterConfig.FilterIdLow = (0x0450 << 3) | CAN_ID_EXT;
//   CAN1_sFilterConfig.FilterMaskIdHigh =(0x0450 << 3) >> 16;
//   CAN1_sFilterConfig.FilterMaskIdLow =(0x0450 << 3) ;
  CAN1_sFilterConfig.FilterFIFOAssignment = CAN_RX_FIFO0;
  CAN1_sFilterConfig.FilterActivation = ENABLE;
  CAN1_sFilterConfig.SlaveStartFilterBank = 0;
  
  if(HAL_CAN_ConfigFilter(&hcan1, &CAN1_sFilterConfig) != HAL_OK)
  {
    #ifdef DEBUG
    DEBUG_ERROR("CAN1 filter initialization fail...\r\n");
    #endif
    /* Filter configuration Error */
    Error_Handler();
  }
	
  if (HAL_CAN_Start(&hcan1) != HAL_OK)
  {
    #ifdef DEBUG
    DEBUG_ERROR("CAN1 start fail...\r\n");
    #endif
    /* Start Error */
    Error_Handler();
  }

  if (HAL_CAN_ActivateNotification(&hcan1, CAN_IT_RX_FIFO0_MSG_PENDING) != HAL_OK)
  {
    #ifdef DEBUG
    DEBUG_ERROR("CAN1 activateNotification fail...\r\n");
    #endif
    /* Notification Error */
    Error_Handler();
  }

  //CAN1_RX_EndFlag  = 1;	for 2 board can test
  /* Infinite loop */
  for(;;)
  {

	if(CAN1_RX_EndFlag){
		if(HAL_CAN_GetTxMailboxesFreeLevel( &hcan1 ) != 0){        
			CAN1_TxHeader.ExtId = 0x456;
			CAN1_TxHeader.IDE = CAN_ID_EXT;      // IDE = CAN_ID_EXT means Extended ID message.
			//CAN1_TxHeader.SRR = 0;    //stm32 hal lib not .SRR
			CAN1_TxHeader.RTR = 0;      // Not an RTR message.
			CAN1_TxHeader.DLC = 1;      // Send one byte of data.
			CAN1_TxData[0] = 0xAA;
			// CAN1_TxData[1] = 0x22;
			// CAN1_TxData[2] = 0x33;
			// CAN1_TxData[3] = 0x44;
			// CAN1_TxData[4] = 0x55;
			// CAN1_TxData[5] = 0x66;
			// CAN1_TxData[6] = 0x77;
			// CAN1_TxData[7] +=1;
				if (HAL_CAN_AddTxMessage(&hcan1, &CAN1_TxHeader, CAN1_TxData, &CAN1_TxMailbox) != HAL_OK)
					{			
						Error_Handler();
					}
			CAN1_RX_EndFlag = 0;		
		//	osDelay(1000);	
		}			
    }
	
	// osDelay(1000);	
    // if(HAL_CAN_GetTxMailboxesFreeLevel( &hcan1 ) != 0){
        
    //     CAN1_TxHeader.ExtId = 0x123;
    //     CAN1_TxHeader.IDE = CAN_ID_EXT;      // IDE = CAN_ID_EXT means Extended ID message.
    //     //CAN1_TxHeader.SRR = 0;    //stm32 hal lib not .SRR
    //     CAN1_TxHeader.RTR = 0;      // Not an RTR message.
    //     CAN1_TxHeader.DLC = 8;      // Send one byte of data.
	// 	CAN1_TxData[0] = 0xAA;
	// 	CAN1_TxData[1] = 0xBB;
	// 	CAN1_TxData[2] = 0xCC;
	// 	CAN1_TxData[3] = 0xDD;
	// 	CAN1_TxData[4] = 0xEE;
	// 	CAN1_TxData[5] = 0xFF;
	// 	CAN1_TxData[6] = 0x11;
	// 	CAN1_TxData[7] = 0x22;           
    
        
	// 	if (HAL_CAN_AddTxMessage(&hcan1, &CAN1_TxHeader, CAN1_TxData, &CAN1_TxMailbox) != HAL_OK)
	// 	{			
	// 		Error_Handler();
	// 	}
    // }

    osDelay(1);
  }
  /* USER CODE END canTask */
}

/* Private application code --------------------------------------------------*/
/* USER CODE BEGIN Application */
/**
 * @brief  Sets the selected data port bits.
 * @param  GPIOx: where x can be (A..G) to select the GPIO peripheral.
 * @param  GPIO_Pin: specifies the port bits to be written.
 *   This parameter can be any combination of GPIO_Pin_x where x can be (0..15).
 * @retval None
 */
// void GPIO_SetBits(GPIO_TypeDef* GPIOx, uint16_t GPIO_Pin)
//{
//   /* Check the parameters */
//   assert_param(IS_GPIO_ALL_PERIPH(GPIOx));
//   assert_param(IS_GPIO_PIN(GPIO_Pin));
//
//   GPIOx->BSRR = GPIO_Pin;
// }

/**
 * @brief  Clears the selected data port bits.
 * @param  GPIOx: where x can be (A..G) to select the GPIO peripheral.
 * @param  GPIO_Pin: specifies the port bits to be written.
 *   This parameter can be any combination of GPIO_Pin_x where x can be (0..15).
 * @retval None
 */
// void GPIO_ResetBits(GPIO_TypeDef* GPIOx, uint16_t GPIO_Pin)
//{
//   /* Check the parameters */
//   assert_param(IS_GPIO_ALL_PERIPH(GPIOx));
//   assert_param(IS_GPIO_PIN(GPIO_Pin));
//
//   GPIOx->BRR = GPIO_Pin;
// }


void nTestIO(GPIO_TypeDef *GPIO_out_port, uint16_t GPIO_out_Pin, GPIO_TypeDef *GPIO_in_port, uint16_t GPIO_in_Pin, uint8_t nItem)
{

	HAL_GPIO_WritePin(GPIO_out_port, GPIO_out_Pin, GPIO_PIN_SET);
	HAL_Delay(Multi_Relay_Delay_Time);
	if (HAL_GPIO_ReadPin(GPIO_in_port, GPIO_in_Pin) == GPIO_PIN_RESET)
		sf_t.SF_Config.data.value &= ~((uint64_t)1 << nItem);
	else{
		sf_t.SF_Config.data.value |= ((uint64_t)1 << nItem); // Fail
		return;
	}	

	HAL_GPIO_WritePin(GPIO_out_port, GPIO_out_Pin, GPIO_PIN_RESET);
	HAL_Delay(Multi_Relay_Delay_Time);
	if (HAL_GPIO_ReadPin(GPIO_in_port, GPIO_in_Pin) == GPIO_PIN_SET)
		sf_t.SF_Config.data.value &= ~((uint64_t)1 << nItem);
	else
		sf_t.SF_Config.data.value |= ((uint64_t)1 << nItem); // Fail
}

void nTestIO1(GPIO_TypeDef *GPIO_out_port, uint16_t GPIO_out_Pin, GPIO_TypeDef *GPIO_in_port, uint16_t GPIO_in_Pin, uint8_t nItem)
{

	HAL_GPIO_WritePin(GPIO_out_port, GPIO_out_Pin, GPIO_PIN_SET);
	HAL_Delay(Multi_Relay_Delay_Time);
	if (HAL_GPIO_ReadPin(GPIO_in_port, GPIO_in_Pin) == GPIO_PIN_SET)
		sf_t.SF_Config.data.value &= ~((uint64_t)1 << nItem);
	else{
		sf_t.SF_Config.data.value |= ((uint64_t)1 << nItem); // Fail
		return;
	}	

	HAL_GPIO_WritePin(GPIO_out_port, GPIO_out_Pin, GPIO_PIN_RESET);
	HAL_Delay(Multi_Relay_Delay_Time);
	if (HAL_GPIO_ReadPin(GPIO_in_port, GPIO_in_Pin) == GPIO_PIN_RESET)
		sf_t.SF_Config.data.value &= ~((uint64_t)1 << nItem);
	else
		sf_t.SF_Config.data.value |= ((uint64_t)1 << nItem); // Fail
}

void nTestEXT_INT(GPIO_TypeDef *GPIO_out_port, uint16_t GPIO_out_Pin,uint8_t *flag,uint8_t nItem)
{
	*flag = 0;
	HAL_GPIO_WritePin(GPIO_out_port, GPIO_out_Pin, GPIO_PIN_SET);
	HAL_Delay(Multi_Relay_Delay_Time);

	if(*flag){
		sf_t.SF_Config.data.value &= ~((uint64_t)1 << nItem);	
	}else{		
		sf_t.SF_Config.data.value |= ((uint64_t)1 << nItem); // Fail			
	}		
	HAL_GPIO_WritePin(GPIO_out_port, GPIO_out_Pin, GPIO_PIN_RESET);
	HAL_Delay(Multi_Relay_Delay_Time);
}

uint8_t isValidCheckSum(void)
{
	uint8_t result = OFF;
	uint8_t chksum = 0x00;

	if (uart_rx_buffer[0] == PROTOCOL_HEAD)
	{
		for (int idx = 0; idx < (uart_rx_buffer[4] | (uart_rx_buffer[5] << 8)); idx++)
		{
			chksum ^= uart_rx_buffer[(6 + idx)];
		}

		if (chksum == uart_rx_buffer[(6 + (uart_rx_buffer[4] | (uart_rx_buffer[5] << 8)))])
			result = ON;
	}

	return result;
}

// two points
void CLC_Corr_Gain_Par(uint16_t SpecData_H, uint16_t SpecData_L, uint16_t MCUData_H, uint16_t MCUData_L, float *GainA, float *GainB)
{
	*GainA = (float)((float)(SpecData_H - SpecData_L) / (float)(MCUData_H - MCUData_L));
	*GainB = (float)(SpecData_H - (float)(*GainA * MCUData_H));
}

// three points
uint16_t acVolCalWithGain(uint16_t orgValue, uint8_t phase)
{
	uint16_t result = 0;

	if ((Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][MCU_DATA] != Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][MCU_DATA]) &&
		(Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][MCU_DATA] != Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][MCU_DATA]) &&
		(Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][MCU_DATA] != Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][MCU_DATA]))
	{
		// If denominator not equal 0, calculate orgValue with Lagrange polynomial
		result = (uint16_t)((((orgValue - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][MCU_DATA]) * (orgValue - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][MCU_DATA])) / (float)((Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][MCU_DATA] - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][MCU_DATA]) * (Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][MCU_DATA] - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][MCU_DATA]))) * Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][METER_DATA] +
							(((orgValue - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][MCU_DATA]) * (orgValue - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][MCU_DATA])) / (float)((Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][MCU_DATA] - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][MCU_DATA]) * (Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][MCU_DATA] - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][MCU_DATA]))) * Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][METER_DATA] +
							(((orgValue - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][MCU_DATA]) * (orgValue - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][MCU_DATA])) / (float)((Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][MCU_DATA] - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 0][MCU_DATA]) * (Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][MCU_DATA] - Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 1][MCU_DATA]))) * Module_Info.memory.Module_Config.data.item.Correction_Volt[(phase * 3) + 2][METER_DATA]);
	}
	else
	{
		// If denominator equal 0, pass orgValue as result
		result = orgValue;
	}

	return result;
}



void IOdebug(void)
{	
	HAL_GPIO_WritePin(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR1_RLY_n_Enable_GPIO_Port, SMR1_RLY_n_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR2_RLY_n_Enable_GPIO_Port, SMR2_RLY_n_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR3_RLY_p_Enable_GPIO_Port, SMR3_RLY_p_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR3_RLY_n_Enable_GPIO_Port, SMR3_RLY_n_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR4_RLY_p_Enable_GPIO_Port, SMR4_RLY_p_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR4_RLY_n_Enable_GPIO_Port, SMR4_RLY_n_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR5_RLY_p_Enable_GPIO_Port, SMR5_RLY_p_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR5_RLY_n_Enable_GPIO_Port, SMR5_RLY_n_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR6_RLY_p_Enable_GPIO_Port, SMR6_RLY_p_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(SMR6_RLY_n_Enable_GPIO_Port, SMR6_RLY_n_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(Precharge1_Enable_GPIO_Port, Precharge1_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(Precharge2_Enable_GPIO_Port, Precharge2_Enable_Pin, GPIO_PIN_SET);		

	HAL_GPIO_WritePin(Contactor_Enable_GPIO_Port, Contactor_Enable_Pin, GPIO_PIN_SET);
	HAL_GPIO_WritePin(PSU_Enable1_GPIO_Port, PSU_Enable1_Pin, GPIO_PIN_SET);	
	HAL_GPIO_WritePin(PSU_Enable2_GPIO_Port, PSU_Enable2_Pin, GPIO_PIN_SET);	
	HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_SET);	
	HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_SET);	
	osDelay(200);		

	Module_Info.Relay_Status.flags.SMR1_relay_n = ~HAL_GPIO_ReadPin(SMR1_Relay_n_Ret_GPIO_Port, SMR1_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR1_relay_p = ~HAL_GPIO_ReadPin(SMR1_Relay_p_Ret_GPIO_Port, SMR1_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR2_relay_n = ~HAL_GPIO_ReadPin(SMR2_Relay_n_Ret_GPIO_Port, SMR2_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR2_relay_p = ~HAL_GPIO_ReadPin(SMR2_Relay_p_Ret_GPIO_Port, SMR2_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR3_relay_n = ~HAL_GPIO_ReadPin(SMR3_Relay_n_Ret_GPIO_Port, SMR3_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR3_relay_p = ~HAL_GPIO_ReadPin(SMR3_Relay_p_Ret_GPIO_Port, SMR3_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR4_relay_n = ~HAL_GPIO_ReadPin(SMR4_Relay_n_Ret_GPIO_Port, SMR4_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR4_relay_p = ~HAL_GPIO_ReadPin(SMR4_Relay_p_Ret_GPIO_Port, SMR4_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR5_relay_n = ~HAL_GPIO_ReadPin(SMR5_Relay_n_Ret_GPIO_Port, SMR5_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR5_relay_p = ~HAL_GPIO_ReadPin(SMR5_Relay_p_Ret_GPIO_Port, SMR5_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR6_relay_n = ~HAL_GPIO_ReadPin(SMR6_Relay_n_Ret_GPIO_Port, SMR6_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR6_relay_p = ~HAL_GPIO_ReadPin(SMR6_Relay_p_Ret_GPIO_Port, SMR6_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.Precharge1   = ~HAL_GPIO_ReadPin(Precharge1_Ret_GPIO_Port, Precharge1_Ret_Pin);
	Module_Info.Relay_Status.flags.Precharge2   = ~HAL_GPIO_ReadPin(Precharge2_Ret_GPIO_Port, Precharge2_Ret_Pin);
	// printf("RELAY ON:%llx\r\n", Module_Info.Relay_Status.All);
	printf("RELAY ON:S1:%x     S2:%x     S3:%x     S4:%x\r\n",Module_Info.Relay_Status.Status[0],Module_Info.Relay_Status.Status[1],Module_Info.Relay_Status.Status[2],Module_Info.Relay_Status.Status[3]);
	printf("RELAY ON:S5:%x     S6:%x     S7:%x\r\n\r\n",Module_Info.Relay_Status.Status[4],Module_Info.Relay_Status.Status[5],Module_Info.Relay_Status.Status[6]);
	osDelay(1800);		 
	
	HAL_GPIO_WritePin(SMR1_RLY_p_Enable_GPIO_Port, SMR1_RLY_p_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR1_RLY_n_Enable_GPIO_Port, SMR1_RLY_n_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR2_RLY_p_Enable_GPIO_Port, SMR2_RLY_p_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR2_RLY_n_Enable_GPIO_Port, SMR2_RLY_n_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR3_RLY_p_Enable_GPIO_Port, SMR3_RLY_p_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR3_RLY_n_Enable_GPIO_Port, SMR3_RLY_n_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR4_RLY_p_Enable_GPIO_Port, SMR4_RLY_p_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR4_RLY_n_Enable_GPIO_Port, SMR4_RLY_n_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR5_RLY_p_Enable_GPIO_Port, SMR5_RLY_p_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR5_RLY_n_Enable_GPIO_Port, SMR5_RLY_n_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR6_RLY_p_Enable_GPIO_Port, SMR6_RLY_p_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(SMR6_RLY_n_Enable_GPIO_Port, SMR6_RLY_n_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(Precharge1_Enable_GPIO_Port, Precharge1_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(Precharge2_Enable_GPIO_Port, Precharge2_Enable_Pin, GPIO_PIN_RESET);

	HAL_GPIO_WritePin(Contactor_Enable_GPIO_Port, Contactor_Enable_Pin, GPIO_PIN_RESET);
	HAL_GPIO_WritePin(PSU_Enable1_GPIO_Port, PSU_Enable1_Pin, GPIO_PIN_RESET);	
	HAL_GPIO_WritePin(PSU_Enable2_GPIO_Port, PSU_Enable2_Pin, GPIO_PIN_RESET);	
	HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);	
	HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET);
	osDelay(200);
	Module_Info.Relay_Status.flags.SMR1_relay_n = ~HAL_GPIO_ReadPin(SMR1_Relay_n_Ret_GPIO_Port, SMR1_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR1_relay_p = ~HAL_GPIO_ReadPin(SMR1_Relay_p_Ret_GPIO_Port, SMR1_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR2_relay_n = ~HAL_GPIO_ReadPin(SMR2_Relay_n_Ret_GPIO_Port, SMR2_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR2_relay_p = ~HAL_GPIO_ReadPin(SMR2_Relay_p_Ret_GPIO_Port, SMR2_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR3_relay_n = ~HAL_GPIO_ReadPin(SMR3_Relay_n_Ret_GPIO_Port, SMR3_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR3_relay_p = ~HAL_GPIO_ReadPin(SMR3_Relay_p_Ret_GPIO_Port, SMR3_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR4_relay_n = ~HAL_GPIO_ReadPin(SMR4_Relay_n_Ret_GPIO_Port, SMR4_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR4_relay_p = ~HAL_GPIO_ReadPin(SMR4_Relay_p_Ret_GPIO_Port, SMR4_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR5_relay_n = ~HAL_GPIO_ReadPin(SMR5_Relay_n_Ret_GPIO_Port, SMR5_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR5_relay_p = ~HAL_GPIO_ReadPin(SMR5_Relay_p_Ret_GPIO_Port, SMR5_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR6_relay_n = ~HAL_GPIO_ReadPin(SMR6_Relay_n_Ret_GPIO_Port, SMR6_Relay_n_Ret_Pin);
	Module_Info.Relay_Status.flags.SMR6_relay_p = ~HAL_GPIO_ReadPin(SMR6_Relay_p_Ret_GPIO_Port, SMR6_Relay_p_Ret_Pin);
	Module_Info.Relay_Status.flags.Precharge1   = ~HAL_GPIO_ReadPin(Precharge1_Ret_GPIO_Port, Precharge1_Ret_Pin);
	Module_Info.Relay_Status.flags.Precharge2   = ~HAL_GPIO_ReadPin(Precharge2_Ret_GPIO_Port, Precharge2_Ret_Pin);
	// printf("RELAY OFF:%llx\r\n", Module_Info.Relay_Status.All);
	printf("RELAY OFF:S1:%x     S2:%x     S3:%x     S4:%x\r\n",Module_Info.Relay_Status.Status[0],Module_Info.Relay_Status.Status[1],Module_Info.Relay_Status.Status[2],Module_Info.Relay_Status.Status[3]);
	printf("RELAY OFF:S5:%x     S6:%x     S7:%x\r\n\r\n",Module_Info.Relay_Status.Status[4],Module_Info.Relay_Status.Status[5],Module_Info.Relay_Status.Status[6]);

	osDelay(1800);	
}	

/* USER CODE END Application */