File name
Commit message
Commit date
File name
Commit message
Commit date
File name
Commit message
Commit date
File name
Commit message
Commit date
//-------------------------------------------------------//
// Project Code : V2H6K01-23-ENEMAN
// File Name : Relay.cpp
// Created on : 2023. 8. 8.
// Description :
// Author : KimJeongWoo
// Last modified Date :
//-------------------------------------------------------//
#include "Cpu1DeviceDefine.h"
//----Main-AcRelay(ALZ51B12)--------//
// Operate time : Max. 15ms //
// Release time : Max. 5ms //
//----------------------------------//
//---AcPreCharge-Relay(ALDP112W)----//
// Operate Time : Max. 10ms //
// Release time : Max. 10ms //
//----------------------------------//
//---DcPreCharge-Relay()------------//
unsigned int FlagAcPreCharge = 0;
unsigned int FlagBatPreCharge = 0;
float AcRelaySetVolt = 20;//250
float BatRelaySetVolt = 250.;//130;
void InitRelay()
{
InitRelayTime();
InitCntAcPreCharge();
InitCntBatPreCharge();
InitAcRelay();
InitBatRelay();
DigitalOutput();
delay_ms(100L);
}
void InitAcRelay()
{
// Dout.Data.bit.RelayGridPreCharge = 0;
// Dout.Data.bit.RelayGridUN = 0;
// Dout.Data.bit.RelayGridNW = 0;
//
// Dout.Data.bit.RelayLoadUN = 0;
// Dout.Data.bit.RelayLoadNW = 0;
}
void InitBatRelay()
{
// Dout.Data.bit.RelayBatPreCharge = 0;
// Dout.Data.bit.RelayBatP = 0;
// Dout.Data.bit.RelayBatN = 0;
}
void InitRelayTime()
{
SetAcPreChargeWait = (int) (0.5 * INV_T2ms);
SetBatPreChargeWait = (int) (0.5 * INV_T2ms);
SetPreAcPreRelayWait = (int) (0.5 * INV_T2ms);
SetPreAcRelayWait = (int) (5. * INV_T2ms);
SetPreAcRelayDetect = (int) (0.5 * INV_T2ms);
SetPreAcPreRelayDetect = (int) (0.5 * INV_T2ms);
SetPreAcRelayDelay = (int) (0.5 * INV_T2ms);
SetPreBatPreRelayWait = (int) (0.5 * INV_T2ms);
SetPreBatRelayWait = (int) (3. * INV_T2ms);
SetPreBatRelayDetect = (int) (0.5 * INV_T2ms);
SetPreBatPreRelayDetect = (int) (0.5 * INV_T2ms);
SetPreBatRelayDelay = (int) (0.5 * INV_T2ms);
}
void InitCntAcPreCharge()
{
CntPreAcPreRelayWait = SetPreAcPreRelayWait;
CntPreAcRelayWait = SetPreAcRelayWait;
CntPreAcPreRelayDetect = SetPreAcPreRelayDetect;
CntPreAcRelayDetect = SetPreAcRelayDetect;
CntPreAcRelayDelay = SetPreAcRelayDelay;
CntAcPreChargeWait = 0;
}
void InitCntBatPreCharge()
{
CntPreBatPreRelayWait = SetPreBatPreRelayWait;
CntPreBatRelayWait = SetPreBatRelayWait;
CntPreBatRelayDetect = SetPreBatRelayDetect;
CntPreBatPreRelayDetect = SetPreBatPreRelayDetect;
CntPreBatRelayDelay = SetPreBatRelayDelay;
CntBatPreChargeWait = 0;
}
int CntBatPreChargeWait = 0, SetBatPreChargeWait = 0;
int CntPreBatPreRelayWait = 0, SetPreBatPreRelayWait = 0;
int CntPreBatPreRelayDetect = 0, SetPreBatPreRelayDetect = 0;
int CntPreBatRelayWait = 0, SetPreBatRelayWait = 0;
int CntPreBatRelayDetect = 0, SetPreBatRelayDetect = 0;
int CntPreBatRelayDelay = 0, SetPreBatRelayDelay = 0;
int StatusBatPreCharge = 0;
void PreChargeBatRelay(float BatRelaySetVolt)
{
// if ((FlagRunBoost == 1) || (ModeSystem == 1)) FlagBatPreCharge = FlagBatPreCharge;
// else FlagBatPreCharge = 0, StatusBatPreCharge = 0;
//
// if ((FlagBatPreCharge == 1) && (SystemFault == 0))
// {
// if (StatusBatPreCharge == 0)
// {
// if (--CntPreBatPreRelayWait <= 0)
// {
// Dout.Data.bit.RelayBatPreCharge = 1;
// Dout.Data.bit.RelayBatN = 1;
// CntPreBatPreRelayWait = SetPreBatPreRelayWait;
// }
//
// if ((Dout.Data.bit.RelayBatPreCharge == 1) && (Dout.Data.bit.RelayBatN == 1))
// {
// if (--CntPreBatRelayWait <= 0)
// {
// CntPreBatRelayWait = SetPreBatRelayWait;
//
// if (CH1_IR_Flt > BatRelaySetVolt)
// {
// Dout.Data.bit.RelayBatP = 1;
// }
// else Fault.Sw1.bit.DcPreCharge |= 1;
// }
// }
// if ((Dout.Data.bit.RelayBatP == 1) && (Dout.Data.bit.RelayBatN == 1))
// {
// if (--CntPreBatRelayDelay <= 0)
// {
// if (++CntBatPreChargeWait > SetBatPreChargeWait)
// {
// InitCntBatPreCharge();
// Dout.Data.bit.RelayBatPreCharge = 0;
// CntBatPreChargeWait = 0;
// StatusBatPreCharge = 1;
// }
// }
// }
// }
// if (StatusBatPreCharge == 1) FlagBatPreCharge = 0;
// }
// else
// {
// FlagBatPreCharge = 0;
// InitCntBatPreCharge();
// }
}
int CntAcPreChargeWait = 0, SetAcPreChargeWait = 0;
int CntPreAcPreRelayWait = 0, SetPreAcPreRelayWait = 0;
int CntPreAcPreRelayDetect = 0, SetPreAcPreRelayDetect = 0;
int CntPreAcRelayWait = 0, SetPreAcRelayWait = 0;
int CntPreAcRelayDetect = 0, SetPreAcRelayDetect = 0;
int CntPreAcRelayDelay = 0, SetPreAcRelayDelay = 0;
int StatusAcPreCharge = 0;
float RelayAcOntimeMin = -2.82;
float RelayAcOntimeMax = -2.50;
void PreChargeAcRelay(float AcRelaySetVolt)
{
// if ((FlagRunInv == 1) || (ModeSystem == 1)) FlagAcPreCharge = FlagAcPreCharge;
// else FlagAcPreCharge = 0, StatusAcPreCharge = 0;
//
// if ((FlagAcPreCharge == 1) && (SystemFault == 0))
// {
// if (StatusAcPreCharge == 0)
// {
// if (--CntPreAcPreRelayWait <= 0)
// {
//// if ((Theta >= RelayAcOntimeMin) && (Theta <= RelayAcOntimeMax))
//// {
// Dout.Data.bit.RelayGridPreCharge = 1;
// CntPreAcPreRelayWait = SetPreAcPreRelayWait;
//// }
// }
// if (Dout.Data.bit.RelayGridPreCharge == 1)
// {
// if (--CntPreAcRelayWait <= 0)
// {
// CntPreAcRelayWait = SetPreAcRelayWait;
//
// if (CH3_UV_Flt > AcRelaySetVolt)
// {
//// if ((Theta >= RelayAcOntimeMin) && (Theta >= RelayAcOntimeMax))
//// {
// Dout.Data.bit.RelayGridUN = 1;
// Dout.Data.bit.RelayGridNW = 1;
//// }
// }
// else Fault.Sw1.bit.AcPreCharge = 1;
// }
// }
//
// if ((Dout.Data.bit.RelayGridUN == 1) && (Dout.Data.bit.RelayGridNW == 1))
// {
// if (--CntPreAcRelayDelay <= 0)
// {
// if (++CntAcPreChargeWait > SetAcPreChargeWait)
// {
// InitCntAcPreCharge();
// Dout.Data.bit.RelayGridPreCharge = 0;
//
// CntAcPreChargeWait = 0;
// StatusAcPreCharge = 1;
// }
// }
// }
// }
// if (StatusAcPreCharge == 1) FlagAcPreCharge = 0;
// }
// else
// {
// FlagAcPreCharge = 0;
// InitCntAcPreCharge();
// }
//todo 동작시 접점 확인 및 폴트 추가 할 것
}
unsigned int FlagLoadRelayOn = 0;
void LoadRelay()
{
// if(FlagLoadRelayOn == 1)
// {
// Dout.Data.bit.RelayLoadUN = 1;
// Dout.Data.bit.RelayLoadNW = 1;
// }
// else
// {
// Dout.Data.bit.RelayLoadUN = 0;
// Dout.Data.bit.RelayLoadNW = 0;
// }
}