#include "protect_check.h"
#include "math_tools.h"
#include "gpio.h"
#include "hall_sensor.h"
#include "eeprom_24c02.h"

/*****************************全局变量定义*******************************/
//过流保护检测参数
FlagStatus MC_Protect_OverCurrentTrig_Flag = RESET;

/******************************局部函数定义******************************/
//低压保护检测
void MC_Protect_UnderVoltage_Process(uint16_t BusVoltage, uint8_t DesignVoltage, MC_ErrorCode_Struct_t* p_MC_ErrorCode)
{
  static uint32_t uvTimeCnt = 0;
	static uint32_t uvFaultTimeCnt = 0;
	uint16_t UV_Voltage = 0;
	
	//根据额定电压更新保护阈值
	switch(DesignVoltage)
	{
		case 24:
		{
			UV_Voltage = 3100 * 7;//低压保护时，电芯电压为3100mV
		  break;
		}
		case 36:
		{
			UV_Voltage = 3100 * 10;//低压保护时，电芯电压为3100mV
		  break;
		}
		case 48:
		{
			UV_Voltage = 3100 * 13;//低压保护时，电芯电压为3100mV
		  break;
		}
		default:
		{
  		UV_Voltage = BusVoltage;
			break;
		}
	}
	if(p_MC_ErrorCode->ERROR_Bit.Protect_UnderVoltage == 0)
	{
		//低压保护判断
		if(BusVoltage >= UV_Voltage)
		{
			uvTimeCnt = HAL_GetTick();
		}
		if((HAL_GetTick() - uvTimeCnt) > 5000)
		{
			p_MC_ErrorCode->ERROR_Bit.Protect_UnderVoltage = 1;
			MC_RunLog1.UV_ProtectCnt++;
			SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
		}
		uvFaultTimeCnt = HAL_GetTick();
	}
	else
	{
		//低压保护恢复
		if(BusVoltage < (UV_Voltage + 200))
		{
			uvFaultTimeCnt = HAL_GetTick();
		}	
		if((HAL_GetTick() - uvFaultTimeCnt) > 3000)
		{
			p_MC_ErrorCode->ERROR_Bit.Protect_UnderVoltage = 0;
		}
	}
}

//过压保护检测
void MC_Protect_OverVoltage_Process(uint16_t BusVoltage, uint16_t DesignVoltage, MC_ErrorCode_Struct_t* p_MC_ErrorCode)
{
  static uint32_t ovTimeCnt = 0;
	static uint32_t ovFaultTimeCnt = 0;
	uint16_t OV_Voltage = 0;
	
	//根据额定电压更新保护阈值
	switch(DesignVoltage)
	{
		case 24:
		{
			OV_Voltage = 4500 * 7;//过压保护时，电芯电压为4500mV
		  break;
		}
		case 36:
		{
			OV_Voltage = 4500 * 10;//过压保护时，电芯电压为4500mV
		  break;
		}
		case 48:
		{
			OV_Voltage = 4500 * 13;//过压保护时，电芯电压为4500mV
		  break;
		}
		default:
		{
  		OV_Voltage = BusVoltage;
			break;
		}
	}
	if(p_MC_ErrorCode->ERROR_Bit.Protect_OverVoltage == 0)
	{
		//过压保护判断
		if(BusVoltage <= OV_Voltage)
		{
			ovTimeCnt = HAL_GetTick();
		}
		if((HAL_GetTick() - ovTimeCnt) > 5000)
		{
			p_MC_ErrorCode->ERROR_Bit.Protect_OverVoltage = 1;
			MC_RunLog1.OV_ProtectCnt++;
			SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
		}
		ovFaultTimeCnt = HAL_GetTick();
	}
	else
	{
		//过压保护恢复
		if(BusVoltage > (OV_Voltage - 200))
		{
			ovFaultTimeCnt = HAL_GetTick();
		}	
		if((HAL_GetTick() - ovFaultTimeCnt) > 3000)
		{
			p_MC_ErrorCode->ERROR_Bit.Protect_OverVoltage = 0;
		}	
	}
}

//堵转保护检测
void MC_Protect_RotorLock_Process(uint16_t BusCurrent, TrueOrFalse_Flag_Struct_t IsStopFlag, MC_ErrorCode_Struct_t* p_MC_ErrorCode)
{
  static uint32_t Protect_1st_TimeCnt = 0;
	static uint32_t Protect_2st_TimeCnt = 0;
	static uint32_t FaultTimeCnt = 0;
	
	if(p_MC_ErrorCode->ERROR_Bit.Protect_LockRotor == 0)
	{
		//堵转保护检测
		//一级电流堵转：电流大于2.5A，超时8s
		//二级电流堵转：电流大于7.5A，超时3s
		if(IsStopFlag == FALSE)
		{
			Protect_1st_TimeCnt = HAL_GetTick();
			Protect_2st_TimeCnt = HAL_GetTick();
		}
		else
		{
			if(BusCurrent < 2500)
			{
				Protect_1st_TimeCnt = HAL_GetTick();
				Protect_2st_TimeCnt = HAL_GetTick();
			}
			else if(BusCurrent < 7500)
			{
				Protect_2st_TimeCnt = HAL_GetTick();
			}
		}
		if(((HAL_GetTick() - Protect_1st_TimeCnt) > 8000) ||
			 ((HAL_GetTick() - Protect_2st_TimeCnt) > 3000))
		{
			p_MC_ErrorCode->ERROR_Bit.Protect_LockRotor = 1;
			MC_RunLog1.LockRotor_ProtectCnt++;
			SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
			FaultTimeCnt = HAL_GetTick();
		}
	}
	else
	{
		//堵转保护恢复
		if((HAL_GetTick() - FaultTimeCnt) > 5000)
		{
			if((MC_ControlCode.GearSt == MC_GearSt_OFF) &&  //关闭助力
				 (ADC_SensorData.TorqueSensor < 10) &&        //无踩踏力矩
				 (ADC_SensorData.GasSensor < 10) &&           //指拨为0
				 (MC_CadenceResult.IsStopFlag == TRUE))       //踏频停止
			{
				p_MC_ErrorCode->ERROR_Bit.Protect_LockRotor = 0;
			}
		}
	}
}

//过热保护检测
void MC_Protect_OverHeat_Process(uint8_t T_MCU, uint8_t T_PCB, uint8_t T_Coil, uint8_t TH, MC_ErrorCode_Struct_t* p_MC_ErrorCode)
{
  static uint32_t otTimeCnt = 0;
	
	if(p_MC_ErrorCode->ERROR_Bit.Protect_OverTemp == 0)
	{
		//温度传感器相互比较，差值在允许范围内进行处理
		if(((T_MCU < (50 + T_PCB))  || (T_PCB < (50 + T_MCU))) &&    //PCB温度和MCU温度差值小于50度
			 ((T_MCU < (100 + T_Coil)) || (T_Coil < (100 + T_MCU))))   //绕组温度和MCU温度差值小于100度
		{
			if((T_PCB < (TH - 20)) && (T_Coil < (TH + 15)))
			{
				otTimeCnt = HAL_GetTick();
			}
		}
		else
		{
			if(T_MCU < (TH - 20))
			{
			  otTimeCnt = HAL_GetTick();
			}
		}
		//过热保护判断
		if((HAL_GetTick() - otTimeCnt) > 5000)
		{
			p_MC_ErrorCode->ERROR_Bit.Protect_OverTemp = 1;
			MC_RunLog1.OT_ProtectCnt++;
			SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
		}
	}
	else
	{
		//过热保护恢复
		if(((T_PCB < (TH - 20)) && (T_Coil < (TH  - 20))) || (T_MCU < (TH - 40)))
		{
			p_MC_ErrorCode->ERROR_Bit.Protect_OverTemp = 0;
		}
	}
}

//电压波动异常保护检测
void MC_Protect_VoltageChange_Process(uint16_t Voltage, uint16_t Current, MC_ErrorCode_Struct_t* p_MC_ErrorCode)
{
  static uint32_t PeriodTimeCnt = 0;
	uint32_t DiffSqrtResult = 0;
	static uint8_t TrigCnt = 0;
	static uint16_t Array[10] = {0};
	uint16_t i;
	
	if((HAL_GetTick() - PeriodTimeCnt) >= 100)
	{
	  for(i=0; i<(sizeof(Array) / 2 - 1); i++)
		{
			Array[i] = Array[i + 1];
		}
		Array[sizeof(Array) / 2 - 1] = Voltage;
		DiffSqrtResult = GetStandardDeviation(Array, sizeof(Array) >> 1);
		//保护判断
		if(p_MC_ErrorCode->ERROR_Bit.Protect_VoltageChange == 0)
		{
		  if((Current < 50) && (DiffSqrtResult > 1000))
			{
			  if(TrigCnt > 50) // 5s
				{
				  p_MC_ErrorCode->ERROR_Bit.Protect_VoltageChange = 1;
					MC_RunLog2.VoltageChange_FaultCnt++;
					SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG2, sizeof(MC_RunLog2_Struct_t), (uint8_t*)&MC_RunLog2.MCU_FaultCnt);
				}
			}
			else
			{
			  TrigCnt = 0;
			}
		}
		else 
		{
			//恢复判断
			if(DiffSqrtResult <= 1000)
			{
		  	p_MC_ErrorCode->ERROR_Bit.Protect_VoltageChange = 0;
			}
		}
	}
}

/******************************全局函数定义******************************/
//过流保护检测
void MC_Protect_OverCurrent_Process(FlagStatus* OverCurrentTrigFlag, MC_ErrorCode_Struct_t* p_MC_ErrorCode)
{
  static uint8_t OffPwmCnt = 0;        //过流信号触发后，关闭PWM延时计数
	static uint8_t StarPwmCnt = 0;       //关闭PWM后启动PWM延时技术
  static uint16_t ocCnt = 0;           //过流信号触发计数
  static uint32_t ocTimeCnt = 0;       //过流信号触发计时
	static uint32_t ocFaultTimeCnt = 0;  //过流保护后计时
	
	if(p_MC_ErrorCode->ERROR_Bit.Protect_OverCurrent == 0)
	{
		if(*OverCurrentTrigFlag == RESET)
		{
			//关闭PWM计数清零
			OffPwmCnt = 0;
			//超时15ms过流次数未达到200次，过流计数清零
			if(ocCnt < 199)
			{
				if((HAL_GetTick() - ocTimeCnt) >= 15)
				{
					ocTimeCnt = HAL_GetTick();
					ocCnt = 0;
				}
			}
			//开启PWM
			if(StarPwmCnt == 0)
			{
				StarPwmCnt++;
				Enable_PwmGpio_Out();
			}
		}
		else
		{
			//开启PPWM计数清零
			StarPwmCnt = 0;
			//关闭PWM
			Disable_PwmGpio_Out();
			//2个PWM周期后，过流触发标志复位
			if(OffPwmCnt >= 1)
			{
				*OverCurrentTrigFlag = RESET;
			}
			//过流次数计数
			if(ocCnt < 199)
			{
				ocCnt++;
			}
			//15ms内过流次数达到200次，启动过流保护
			else
			{
				ocCnt = 0;
				p_MC_ErrorCode->ERROR_Bit.Protect_OverCurrent = 1;
				MC_RunLog1.OC_ProtectCnt++;
				SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
				ocFaultTimeCnt = HAL_GetTick();
			}
			OffPwmCnt++;
		}
	}
	else
	{
		//过流恢复
		if((HAL_GetTick() - ocFaultTimeCnt) > 5000)
		{
			MC_ErrorCode.ERROR_Bit.Protect_OverCurrent = 0;
			ocFaultTimeCnt = HAL_GetTick();
			*OverCurrentTrigFlag = RESET;
		}
	}
}

//保护判断
void MC_Protect_Check_Process(void)
{
	//低压保护检测
	MC_Protect_UnderVoltage_Process(MC_RunInfo.BusVoltage, MC_MotorParam.Rate_Voltage, &MC_ErrorCode);

	//过压保护检测
	MC_Protect_OverVoltage_Process(MC_RunInfo.BusVoltage, MC_MotorParam.Rate_Voltage, &MC_ErrorCode);

	//堵转保护检测
	MC_Protect_RotorLock_Process(MC_RunInfo.BusCurrent, MC_HallSensorData.IsStopFlag, &MC_ErrorCode);

	//过热保护检测
	MC_Protect_OverHeat_Process(MC_RunInfo.T_MCU, MC_RunInfo.T_PCB, MC_RunInfo.T_Coil, MC_ConfigParam1.TempTH_Protect, &MC_ErrorCode);

	//电压波动异常保护检测
	MC_Protect_VoltageChange_Process(MC_RunInfo.BusVoltage, MC_RunInfo.BusCurrent, &MC_ErrorCode);
	
}