#include "abnormalManage.h"
#include "parameter.h"
#include "capture.h"
#include "checkTime.h"
#include "FM_GPIO.h"
#include "task.h"
#include "configParameter.h"
#include "capture.h"
#include "bl_chargControl.h"
#include "SOE.h"

//static int checkMode = 0;

/* 软件输出过载标志位 */
static BOOL disChargOverLoad = FALSE;

/* 短路标志位 */
static uint8_t shortCircuit = 0;
static BOOL shortCircuitFlag = FALSE;

/* 硬件过载状态位 */
static uint8_t excessiveLoad = 0;
static BOOL excessiveLoadFlag = FALSE;
static BOOL excessiveLoadInterruptFlag = FALSE;

/**
  * @brief  设定放电过载状态
  * @param  
  * @retval
  *
  */
void setDisChargOverLoad(void)
{
    /* 三段式保护中的第三段 */
    static int num1 = 0;
    if (getDischargCurrent() > g_cfgParameter.thirdStageProtectionCurr) {
        // disChargOverLoad = TRUE;
        num1++;
    } else {
        // disChargOverLoad = FALSE;
        num1 = 0;
    }

    /* 过载时间过长关闭输出 */
    if (num1 >= g_cfgParameter.thirdStageProtectionDelay) {
        num1 = 0;
        setPowerOutput(FALSE);
        disChargOverLoad = TRUE;        
        insertEventsOrderRecord(thirdStageProtection);
    }


    /* 三段式保护中的第二段 */
    static int num2 = 0;
    if (getDischargCurrent() > g_cfgParameter.secondStageProtectionCurr) {
        num2++;
    } else {
        num2 = 0;
    }
    
    /* 过载时间过长关闭输出 */
    if (num2 >= g_cfgParameter.secondStageProtectionDelay) {
        num2 = 0;
        setPowerOutput(FALSE);
        disChargOverLoad = TRUE;
        insertEventsOrderRecord(secondStageProtection);
    }
}

/**
  * @brief  软件短路保护
  * @param  
  * @retval
  *
  */
void setSoftShortCircuit(uint16_t disChargCurrAdcNum)
{
    // /* 三段式保护中的第一段 */
    // static int num = 0;
    // if (getDischargCurrent() > firstStageProtectionCurr) {
    //     num++;
    // } else {
    //     num = 0;
    // }

    /* 三段式保护中的第一段 */
    static int num = 0;
    if (disChargCurrAdcNum > g_cfgParameter.firstStageProtectionValue) {
        num++;
    } else {
        num = 0;
    }

    /* 20uS内都短路则关闭输出 */
    if (num >= g_cfgParameter.firstStageProtectionDelay) {
        setPowerOutput(FALSE);
        shortCircuitFlag = TRUE;
        shortCircuit++;
        insertEventsOrderRecord(firstStageProtection);
        startSoftShortCircuitProtection();
    }
}
void setSoftShortCircuit1(void)
{
    // /* 三段式保护中的第一段 */
    // static int num = 0;
    // if (getDischargCurrent() > firstStageProtectionCurr) {
    //     num++;
    // } else {
    //     num = 0;
    // }

    // /* 三段式保护中的第一段 */
    // static int num = 0;
    // if (getDischargCurrent() > firstStageProtectionCurr) {
    //     num++;
    // } else {
    //     num = 0;
    // }

    // /* 200uS内都短路则关闭输出 */
    // if (num >= firstStageProtectionDelay) {
    //     setPowerOutput(FALSE);
    //     shortCircuitFlag = TRUE;
    //     shortCircuit++;
    //     startSoftShortCircuitProtection();
    // }
}

/**
  * @brief  得到放电过载状态
  * @param
  * @retval
  *
  */
BOOL getChargOverLoad(void)
{
    return disChargOverLoad;
}

/**
  * @brief  设置短路状态位
  * @param  
  * @retval
  *
  */
void setShortCircuit(void)
{
    shortCircuit++;
}

/**
  * @brief  清零短路状位
  * @param  
  * @retval
  *
  */
void zeroShortCircuit(void)
{
    shortCircuit = 0;
}

/**
  * @brief  得到短路状位
  * @param  
  * @retval
  *
  */
uint8_t getShortCircuit(void)
{
    return shortCircuit;
}

/**
  * @brief  设定短路标志位
  * @param  state   TRUE    短路
  *                 FALSE 未短路
  * @retval
  *
  */
void setShortCircuitFlag(BOOL state)
{
    if (state == TRUE || state == FALSE) {
        shortCircuitFlag = state;
    }    
}

/**
  * @brief  得到短路标志位
  * @param
  * @retval
  *
  */
BOOL getShortCircuitFlag(void)
{
    return shortCircuitFlag;
}

/**
  * @brief  设置硬件过载状态位
  * @param  
  * @retval
  *
  */
void setExcessiveLoad(void)
{
    excessiveLoad++;
}

/**
  * @brief  清零硬件过载状态位
  * @param  
  * @retval
  *
  */
void zeroExcessiveLoad(void)
{
    excessiveLoad = 0;
}

/**
  * @brief 得到硬件过载状态位
  * @param  
  * @retval
  *
  */
uint8_t getExcessiveLoad(void)
{
    return excessiveLoad;
}

/**
  * @brief  设定硬件过载标志位
  * @param  state   TRUE    过载
  *                 FALSE 未过载
  * @retval
  *
  */
void setExcessiveLoadFlag(BOOL state)
{
    if (state == TRUE || state == FALSE) {
        excessiveLoadFlag = state;
    }    
}

/**
  * @brief  得到硬件过载标志位
  * @param
  * @retval
  *
  */
BOOL getExcessiveLoadFlag(void)
{
    return excessiveLoadFlag;
}

/**
  * @brief  设置输出状态
  * @param  
  * @retval
  *
  */
 void setPowerOutput(BOOL state)
{
//  static volatile float temp_OUT_VOLT_IN;
//  static volatile float temp_PV_VOLT_OUT;
//  temp_PV_VOLT_OUT = get_PV_VOLT_OUT();
//  temp_OUT_VOLT_IN = get_OUT_VOLT_IN();
    if (state == TRUE) {
        //  if (get_OUT_VOLT_IN() < (get_PV_VOLT_OUT() - 0.1f)) {
//        if (temp_OUT_VOLT_IN < (temp_PV_VOLT_OUT - 0.5f)) {
            POW_FF_PCON_Open();
            POW_OUT_PCON_Open();
        // }
    } else {
        POW_FF_PCON_Close();
        POW_OUT_PCON_Close();
    }
}


/**
  * @brief  判断是否打开充电理想二极管
  * @param
  * @retval
  *
  */
void checkFFMOS_CON(void)
{
    // if (get_CHG_CURR() > 5.0f && FALSE == FFMOS_CON_read()) {
    //     FFMOS_CON_Open();
    // }
    // else if (get_CHG_CURR() < 2.0f && TRUE == FFMOS_CON_read()) {
    //     FFMOS_CON_Close();
    // }

    if (getChargCurrent() > 5.0f && FALSE == FFMOS_CON_read()) {
        FFMOS_CON_Open();
    }
    else if (getChargCurrent() < 2.0f && TRUE == FFMOS_CON_read()) {
        FFMOS_CON_Close();
    }
}

// /**
//   * @brief  判断是否短路
//   * @param
//   * @retval
//   *
//   */
// void checkShortCircuit(void)
// {
//     static num = 0;
//     if (getChargCurrent() > 50.0f) {
//         num++;
//     } else {
//         num = 0;
//     }

//     if (num == g_cfgParameter.softShortTime) {        
//         setPowerOutput(FALSE);
//     }
    

// }

/**
  * @brief  输入功率过低保护
  * @param
  * @retval
  *
  */
void setOverLoad(void)
{
    setPowerOutput(FALSE);
    setExcessiveLoad();
    /* 第一次进入输出过载，启动过载保护任务 */ 
    if (getExcessiveLoad() == 1) {
        setExcessiveLoadFlag(TRUE);
        startExcessiveLoadProtection();
    }

    /* 多次进入输出过载，关闭输出 */ 
    if (getExcessiveLoad() > 2) {
        zeroExcessiveLoad();
        insertEventsOrderRecord(lowInputLoad);
    }
}

/**
  * @brief  判断是否输入功率过低
  * @param
  * @retval
  *
  */
void lowInputLoadDetection(void)
{
    static int num = 0;    

    if (excessiveLoadInterruptFlag == TRUE && getOutputVoltage() < g_cfgParameter.inputPowerLowDetectionVolt) {
        num++;
    } else {
        num = 0;
        excessiveLoadInterruptFlag = FALSE;
    }
    
    if (excessiveLoadInterruptFlag == TRUE && num == g_cfgParameter.inputPowerLowDetectionDelay) {
        setOverLoad();
    }
}


/**
  * @brief  判断充电电流是否过高，过高则关闭充电
  * @param
  * @retval
  *
  */
void judgeChargCurr(void)
{
    if (getChargCurrent() > g_cfgParameter.maxChargCurr) {
        stopChargWork();
        insertEventsOrderRecord(overchargCurr);
    }
}

void checkAbnormal(void)
{
    // checkTimeInit();
    /* 滤波 */
    adcCaptureFir();
    
    /* 转换 */
    setChargCurrent();
    setDischargCurrent();
    setOutputVoltage();
    setSolarInCircuitVoltage();

    /* 判断 */
    checkFFMOS_CON();
    setDisChargOverLoad();   
    setSoftShortCircuit1();
    lowInputLoadDetection();
    judgeChargCurr();

    

    // checkAbnormalTime = getCheckTime();
}

/**
  * @brief  工作电压异常中断，过载（输入大于输出）
  * @param  
  * @retval
  *
  */
void WORK_VOLT_Interrupt(void)
{
    //  setPowerOutput(FALSE);
    //  setExcessiveLoad();
    //  /* 第一次进入输出过载，启动过载保护任务 */ 
    //  if (getExcessiveLoad() == 1) {
    //      setExcessiveLoadFlag(TRUE);
    //      startExcessiveLoadProtection();
    //  }

    //  /* 多次进入输出过载，关闭输出 */ 
    //  if (getExcessiveLoad() > 2) {
    //      zeroExcessiveLoad();
    //  }
    excessiveLoadInterruptFlag = TRUE;
}

/**
  * @brief  短路中断，输出电流大于一定值
  * @param  
  * @retval
  *
  */
void DSG_PROT_Interrupt(void)
{
    setShortCircuit();
    /* 第一次进入输出短路，启动短路任务 */
    if (getShortCircuit() == 1) {
        setShortCircuitFlag(TRUE);
        startShortCircuitProtection();
    }

    /* 一定时间内第二次进入输出短路保护，关闭输出 */
    else if (getShortCircuit() >= 2) {
        stopShortCircuitProtection();
        setPowerOutput(FALSE);
        zeroShortCircuit();
    }
}