//-------------------------------------------------------//
//        Project Code : V2H6K01-23-ENEMAN
//           File Name : SoftStart.cpp
//          Created on : 2023. 09. 22.
//         Description :
//              Author : KwonJeongMin
//  Last modified Date :
//-------------------------------------------------------//

#include "Cpu1DeviceDefine.h"

struct sRampGen SoftStartCtrlRamp;
float DelSoftStartCtrl = 0.1;
float SoftStartCtrl = 0.97;
float SoftStartDuty = 0.97;

void InitSoftStart(void)
{
    SoftStartCtrlRamp.Init(&SoftStartCtrl, &DelSoftStartCtrl, Tsamp);
    SoftStartCtrlRamp.UpdateSlope();
    SoftStartCtrlRamp.out = 0.97;
}

void SoftStartReset(void)
{
    SoftStartCtrlRamp.Reset();
}

void SoftStart(void)
{
//    SoftStartCtrl = LIMITER(SoftStartCtrl , 0.97 , 0.5);
//    SoftStartDuty = SoftStartCtrlRamp.Run();
//    SoftStartDuty = LIMITER(SoftStartDuty , 0.97 , 0.5);
//
//    //LV Side
//    EPwm2Regs.CMPA.bit.CMPA = DabPwmPrd * SoftStartDuty;
//    EPwm2Regs.CMPB.bit.CMPB = DabPwmPrd - EPwm2Regs.CMPA.bit.CMPA;
//    EPwm3Regs.CMPA.bit.CMPA = DabPwmPrd * (1 - SoftStartDuty);
//    EPwm3Regs.CMPB.bit.CMPB = DabPwmPrd - EPwm3Regs.CMPA.bit.CMPA;
//
//    //HV Side
//    EPwm4Regs.CMPA.bit.CMPA = DabPwmPrd * SoftStartDuty;
//    EPwm4Regs.CMPB.bit.CMPB = DabPwmPrd - EPwm4Regs.CMPA.bit.CMPA;
//    EPwm5Regs.CMPA.bit.CMPA = DabPwmPrd * (1 - SoftStartDuty);
//    EPwm5Regs.CMPB.bit.CMPB = DabPwmPrd - EPwm5Regs.CMPA.bit.CMPA;
//
//    //Phase Shift
//    EPwm2Regs.TBPHS.bit.TBPHS = 0;                              //Set Phase Shift = 0
//    EPwm3Regs.TBPHS.bit.TBPHS = 0;                              //Set Phase Shift = 0
//    EPwm4Regs.TBPHS.bit.TBPHS = TdabPhCnt;                      //Set Phase Shift = DAB Phase Shift Count
//    EPwm5Regs.TBPHS.bit.TBPHS = TdabPhCnt;                      //Set Phase Shift = DAB Phase Shift Count

}