//-------------------------------------------------------//
//        Project Code : V2H6K01-23-ENEMAN
//           File Name : FaultProcess.cpp
//          Created on : 2023. 07. 26.
//         Description :
//              Author : KimJeongWoo
//  Last modified Date :
//-------------------------------------------------------//

#include "Cpu1DeviceDefine.h"

int FT_chk = 0;

void InitFaultSet()
{
	memset(&Fault, 0, (sizeof(Fault) / sizeof(int)));
	InitProtectionSet();
}

void InitInstFaultLevelSet()
{
	//Bat 순시 과전압
	FT_UV_OV.Ratio = 1.00; // 100%
	FT_UV_OV.SetLevel = FT_UV_OV.Ratio * SET_FT_UV_Level;

	//Bat 순시 저전압
	FT_VIS_OV.Ratio = 1.0; // 100%
	FT_VIS_OV.SetLevel = FT_VIS_OV.Ratio * SET_FT_VIS_Level;

	//Bat 순시 과전류
	FT_IR_OV.Ratio = 1.00;// 100%
	FT_IR_OV.SetLevel = FT_IR_OV.Ratio * SET_FT_IR_Level;


}
void InitOverTempLevelSet()
{

    //AC Switch Inverter Over Temperature
    OtNtc5.SetLevel = 85.;

    //AC Switch Inverter Over Temperature
    OtNtc6.SetLevel = 85.;
}

void InitProtectionSet()
{
	InitInstFaultLevelSet();
//	InitOverTempLevelSet();
//	InitFaultFreq();
//	InitFaultVac();
}

void FaultInstType()
{
//	if (CH4_UV_Flt > FT_UV_OV.SetLevel)          Fault.Sw1.bit.CH4_UV_OV |= 1;
//	if (CH4_VIS_Flt > FT_VIS_OV.SetLevel)      Fault.Sw1.bit.CH4_VIS_OV |= 1;
//	if (CH4_IR_Flt > FT_IR_OV.SetLevel)          Fault.Sw1.bit.CH4_IR_OV |= 1;

      if ((CH4_UV_Flt > FT_UV_OV.SetLevel)
              &&(CH4_VIS_Flt > FT_VIS_OV.SetLevel))     Fault.Sw1.bit.CH4_UV_OV |= 1;
      if ((CH4_UV_Flt > FT_UV_OV.SetLevel)
              &&(CH4_VIS_Flt > FT_IR_OV.SetLevel))     Fault.Sw1.bit.CH4_IR_OV |= 1;

}

void OverTempFault()
{
//    if (VntcBoost > OtDcSwBoost.SetLevel)    Fault.Sw1.bit.OtDcSwBoost |= 1;
//    if (VntcLvDab > OtDcSwLvDab.SetLevel)    Fault.Sw1.bit.OtDcSwLvDab |= 1;
//    if (VntcHvDab > OtAcSwHvDab.SetLevel)    Fault.Sw1.bit.OtAcSwHvDab |= 1;
//    if (VntcInv > OtAcSwInv.SetLevel)        Fault.Sw1.bit.OtAcSwInv |= 1;
//
//    if (Vntc5 > OtNtc5.SetLevel)             Fault.Sw1.bit.OtNtc5 |= 1;
//    if (Vntc6 > OtNtc6.SetLevel)             Fault.Sw1.bit.OtNtc6 |= 1;

}

void InitFaultVac(void)
{
//	FT_Combo_1.Ratio = 1.1;
//	FT_Combo_1.SetLevel = FT_Combo_1.Ratio * VacRatePeak;
//	FT_Combo_1.SetTime = 0.16;
//	FT_Combo_1.SetCnt = FT_Combo_1.SetTime * INV_T10ms;
//	FT_Combo_1.ChkCnt = 0;
//	FT_Combo_1.SetStableCnt = FT_Combo_1.SetCnt;
//	FT_Combo_1.StableCnt = 0;
//
//	UvVgrid.Ratio = 0.9;
//	UvVgrid.SetLevel = UvVgrid.Ratio * VacRatePeak;
//	UvVgrid.SetTime = 0.16;
//	UvVgrid.SetCnt = UvVgrid.SetTime * INV_T10ms;
//	UvVgrid.ChkCnt = 0;
//	UvVgrid.SetStableCnt = UvVgrid.SetCnt;
//	UvVgrid.StableCnt = 0;
}

void FaultVac() //10ms
{
//	if (FlagOffset == 3)
//	{
//		if (VqeGridFlt < UvVgrid.SetLevel)
//		{
//			if (++UvVgrid.ChkCnt > UvVgrid.SetCnt)
//			{
//				Fault.Sw1.bit.CH1_VIS_OV |= 1;
//				UvVgrid.ChkCnt = 0;
//			}
//
//			UvVgrid.StableCnt = 0;
//		}
//		else if (VqeGridFlt > FT_Combo_1.SetLevel)
//		{
//			if (++FT_Combo_1.ChkCnt > FT_Combo_1.SetCnt)
//			{
//				Fault.Sw1.bit.CH1_UV_OV |= 1;
//				FT_Combo_1.ChkCnt = 0;
//			}
//
//			FT_Combo_1.StableCnt = 0;
//		}
//		else
//		{
//			if ((++FT_Combo_1.StableCnt > FT_Combo_1.SetStableCnt) && (++UvVgrid.StableCnt > UvVgrid.SetStableCnt))
//			{
//				FT_Combo_1.ChkCnt = 0;
//				FT_Combo_1.StableCnt = 0;
//				UvVgrid.ChkCnt = 0;
//				UvVgrid.StableCnt = 0;
//			}
//		}
//	}
//	else
//	{
//		UvVgrid.ChkCnt = 0;
//		UvVgrid.StableCnt = 0;
//		FT_Combo_1.ChkCnt = 0;
//		FT_Combo_1.StableCnt = 0;
//	}
}

void InitFaultFreq(void)
{
//	OfVac.SetLevel = 60.5;
//	OfVac.SetTime = 0.1;
//	OfVac.SetCnt = OfVac.SetTime * INV_T10ms;
//	OfVac.ChkCnt = 0;
//	OfVac.SetStableCnt = OfVac.SetCnt;
//	OfVac.StableCnt = 0;
//
//	UfVac.SetLevel = 59.3;
//	UfVac.SetTime = 0.1;
//	UfVac.SetCnt = UfVac.SetTime * INV_T10ms;
//	UfVac.ChkCnt = 0;
//	UfVac.SetStableCnt = UfVac.SetCnt;
//	UfVac.StableCnt = 0;

}

void FaultFreq(void) //10ms
{
//	if (FlagOffset == 3)
//	{
//		if (FreqOutFlt > OfVac.SetLevel)
//		{
//			if (++OfVac.ChkCnt > OfVac.SetCnt)
//			{
//				Fault.Sw1.bit.CH1_IR_OV |= 1;
//				OfVac.ChkCnt = 0;
//			}
//
//			OfVac.StableCnt = 0;
//		}
//		else if (FreqOutFlt < UfVac.SetLevel)
//		{
//			if (++UfVac.ChkCnt > UfVac.SetCnt)
//			{
//				Fault.Sw1.bit.CH2_UV_OV |= 1;
//				UfVac.ChkCnt = 0;
//			}
//
//			UfVac.StableCnt = 0;
//		}
//		else
//		{
//			if ((++OfVac.StableCnt > OfVac.SetStableCnt) && (++UfVac.StableCnt > UfVac.SetStableCnt))
//			{
//				OfVac.ChkCnt = 0;
//				OfVac.StableCnt = 0;
//				UfVac.ChkCnt = 0;
//				UfVac.StableCnt = 0;
//			}
//		}
//	}
}

void ContectTypeFault()
{
	//Emergency Stop
//	Fault.Sw2.bit.Switch_EmergencyStop |= Din.Data.bit.ButtonEstop;

}

void DisconnectTempFault()
{
	if (FlagOffset == 3)
	{

	}
}

//unsigned int SetCanMeWait = 5;
//unsigned int CntCanMeWait = 0;
//unsigned int CanMeRxIsrCntOld = 0;
//
//unsigned int SetCanBeWait = 5;
//unsigned int CntCanBeWait = 0;
//unsigned int CanBeRxIsrCntOld = 0;
//
//unsigned int CanMeOff = 0;
//unsigned int CanBeOff = 0;

unsigned int TraceWaitCnt = 0;
unsigned int TraceWaitSet = 800;


void FaultProcess()
{
	SystemFault = 1;
//	SystemReady = 0;

	Dout.Data.bit.Ch00 = 1;
    Dout.Data.bit.Ch01 = 1;

    if(FT_chk == 0)
    {
        FT_uv_vis_correlation = uv_vis_correlation;
        FT_uv_ir_correlation = uv_ir_correlation;
        FT_vis_ir_correlation = vis_ir_correlation;

        FT_uv_vis_change_correlation = uv_vis_change_correlation;
        FT_uv_ir_change_correlation = uv_ir_change_correlation;
        FT_vis_ir_change_correlation = vis_ir_change_correlation;

        FT_uv_change_magnitude = uv_change_magnitude;
        FT_vis_change_magnitude = vis_change_magnitude;
        FT_ir_change_magnitude = ir_change_magnitude;

        FT_stddev = stddev;
        FT_adaptive_threshold = adaptive_threshold;
        FT_latest_change = latest_change;

        FT_chk = 1;
    }



//	GateOutDisable();
//	FlagInvGating = 0;
//	FlagInvGatingInput = 0;
//
//	FlagBoostGating = 0;
//	FlagBoostGatingInput = 0;
//
//    FlagDabGating = 0;
//    FlagDabGatingInput = 0;
//
//    CmdChargeStart = 0;
//    CmdDischargeStart = 0;
//
//	FlagRunInv = 0;
//	CmdInvStart = 0;
//	CmdInvOPset = 99;
//
//	FlagRunBoost = 0;
//	CmdBoostStart = 0;
//	CmdBoostOPset = 99;
//
//    FlagRunDab = 0;
//    CmdDabStart = 0;
//    CmdDabOPset = 99;
//
//	InvReady = 0;
//
//	IbatRef = 0.;
//
////	IqeRef = 0.;
////	IdeRef = 0.;
//
////	VbatRef = 0.;
////	VdabRef = 0.;
//
////	InitCntAcPreCharge();
////	FlagAcPreCharge = 0;
////	StatusAcPreCharge = 0;
//
//	DigitalInput();
//	InitAcRelay();
//	DigitalOutput();
//
//	TinvA = 0;
//	TinvB = 0;
//	TinvACnt = 0;
//	TinvBCnt = 0;
//
//	Tboost = 0;
//	TboostCnt = 0;
//
//	TdabA = 0;
//	TdabB = 0;
//	TdabC = 0;
//	TdabD = 0;
//	TdabPh = 0;
//
//	TdabACnt = 0;
//	TdabBCnt = 0;
//	TdabCCnt = 0;
//    TdabDCnt = 0;
//    TdabPhCnt = 0;

	FaultLatchData();

//	if(FlagTrace == 1)
//	{
//	    if(TraceWaitCnt++ > TraceWaitSet)
//	    {
//	        FlagTrace = 0;
//	    }
//	}
//	else
//	{
//	    TraceWaitCnt = TraceWaitSet;
//	}



}

unsigned int FlagLatch = 0;

void FaultLatchData()
{
//	if (FlagLatch == 0)
//	{
//		FaultLatch.Vbat         = Vbat;
//		FaultLatch.Ibat         = Ibat;
//
//		FaultLatch.Vboost       = Vboost;
//		FaultLatch.Vdab         = Vdab;
//		FaultLatch.GFD          = GFD;
//		FaultLatch.VdcH         = VdcH;
//		FaultLatch.VdcL         = VdcL;
//		FaultLatch.VunGrid      = VunGrid;
//		FaultLatch.VnwGrid      = VnwGrid;
//		FaultLatch.IuInv        = IuInv;
//		FaultLatch.IwInv        = IwInv;
//
//		FaultLatch.Izct         = Izct;
//		FaultLatch.IuGridExt    = IuGridExt;
//		FaultLatch.IwGridExt    = IwGridExt;
//
//		FaultLatch.VntcBoost    = VntcBoost;
//		FaultLatch.VntcLvDab    = VntcLvDab;
//		FaultLatch.VntcHvDab    = VntcHvDab;
//		FaultLatch.VntcInv      = VntcInv;
//		FaultLatch.Vntc5        =
//
//		FaultLatch.VunInv       = VunInv;
//		FaultLatch.VnwInv       = VnwInv;
//		FaultLatch.IuGrid       = IuGrid;
//		FaultLatch.IwGrid       = IwGrid;
//
//		FlagLatch = 1;
//
//	}

}

void FaultChecker()
{
	FaultInstType();
	ContectTypeFault();
	OverTempFault();

	if ((Fault.Sw1.all != 0) || (Fault.Sw2.all != 0) || (Fault.Sw3.all != 0))
	{
		FaultProcess();
	}

	if (SystemFault == 1)
	{
		if (CmdFaultReset == 33)
		{
			FaultReset = 1;
			CmdFaultReset = 99;
		}
	}
	else CmdFaultReset = 99, FaultReset = 0;

	if (SystemFault == 0) FaultReset = 0;
	else if ((SystemFault == 1) && (FaultReset == 1)) SystemRestart();

}

void SystemRestart()
{
	SystemFault = 0;

    Dout.Data.bit.Ch00 = 0;
    Dout.Data.bit.Ch01 = 0;

    Dout.Data.bit.Ch02 = 0;
    Dout.Data.bit.Ch03 = 0;
    Dout.Data.bit.Ch04 = 0;

	Fault.Sw1.all = 0;
	Fault.Sw2.all = 0;
	Fault.Sw3.all = 0;

	FlagOffset = 0;
	SystemReady = 0;

	FaultReset = 0;

	InitAcRelay();
	memset(&FaultLatch, 0, (sizeof(FaultLatch) / sizeof(int)));
	FlagLatch = 0;

	CH4_UV_max = 0;
	CH4_VIS_max = 0;
	CH4_IR_max = 0;

	FT_uv_vis_correlation = 0;
	FT_uv_ir_correlation = 0;
	FT_vis_ir_correlation = 0;

	FT_uv_vis_change_correlation = 0;
    FT_uv_ir_change_correlation = 0;
    FT_vis_ir_change_correlation = 0;

    FT_uv_change_magnitude = 0;
    FT_vis_change_magnitude = 0;
    FT_ir_change_magnitude = 0;

    FT_stddev = 0;
    FT_adaptive_threshold = 0;
    FT_latest_change = 0;

    FT_chk = 0;
}