177 lines
7.3 KiB
C
177 lines
7.3 KiB
C
/*****************************************************************************
|
||
* @copyright 2024-202, . POWER SUPPLY CO., LTD.
|
||
* @file logic_power_distr.c
|
||
* @brief xxxx
|
||
* @author Gary
|
||
* @date 2024/09/28
|
||
* @remark 初修订
|
||
*****************************************************************************/
|
||
#include "logic_comm.h"
|
||
|
||
|
||
/*****************************************************************************
|
||
* @brief 获取功率分配参数
|
||
*
|
||
* @return 0 更新成功 -1 失败 1 无更新
|
||
*****************************************************************************/
|
||
int logic_getPowerDistrParam()
|
||
{
|
||
static allocate_power_t getPowerBuff;
|
||
if (0 != kit_get_allocate_power(&getPowerBuff))
|
||
{
|
||
// INLOG(Log_LOGIC_EN, ERROR_EN, "获取保护配置失败\n");
|
||
return 1;
|
||
}
|
||
|
||
stlogic.para_delivery.task_params.distr.cabintCont = getPowerBuff.pcsNum;
|
||
stlogic.para_delivery.task_params.distr.chgDirection = getPowerBuff.chgDirection;
|
||
stlogic.para_delivery.task_params.distr.allocateMode = getPowerBuff.allocateMode;
|
||
return 0;
|
||
}
|
||
|
||
/*****************************************************************************
|
||
* @brief 分配的期望功率下发
|
||
* @param[in] power_distr_t distPower 运行参数
|
||
* @return -1：下发失败 0：下发成功
|
||
*****************************************************************************/
|
||
void logic_PowerCal(power_distr_t *distPower, float_t tempPower, int loop)
|
||
{
|
||
float_t finalPower = 0;
|
||
// if (distPower->nowDistPower[loop] < 0) // 充电
|
||
if (tempPower < 0) // 充电
|
||
{
|
||
finalPower = -float_min(abs(tempPower), distPower->pcsMaxChaPower[loop]);
|
||
if (float_diff(distPower->nowBmsPower[loop], finalPower)) // 实时功率比较 差距大再下发
|
||
{
|
||
if ((uint8_t)getRtdbPointValue(rtdbType, kDev_Type_EMS, 0, kEms_LogicLog_Enable) == 1)
|
||
{
|
||
KITLOG(LOG_MODBUS_EN, INFO_EN, "柜 %d 功率变化 %.2f kw ==> %.2f kw", loop, distPower->nowDistPower[loop], finalPower * distPower->chgDirection);
|
||
KITPTF(LOG_MODBUS_EN, INFO_EN, "柜 %d 功率变化 %.2f kw ==> %.2f kw", loop, distPower->nowDistPower[loop], finalPower * distPower->chgDirection);
|
||
}
|
||
distPower->nowDistPower[loop] = finalPower * distPower->chgDirection;
|
||
}
|
||
// 调试模式PCS开关由指令决定
|
||
if (stlogic.para_delivery.mode == E_TACTIC_MODE_DEBUG)
|
||
{
|
||
distPower->pcsSwitch[loop] = stlogic.para_delivery.task_params.debug.pcsSwitch;
|
||
}
|
||
else
|
||
{
|
||
// distPower->pcsSwitch[loop] = distPower->pcsOn; // pcs 功能码可定制 在这里
|
||
distPower->pcsSwitch[loop] = 1;
|
||
}
|
||
|
||
// 系统状态更新
|
||
updateState(kState_Charging, true);
|
||
}
|
||
else if (tempPower > 0) // 放电
|
||
{
|
||
finalPower = float_min(tempPower, distPower->pcsMaxDiscPower[loop]);
|
||
if (float_diff(distPower->nowBmsPower[loop], finalPower)) // 与实时功率比较 差距大再下发
|
||
{
|
||
if ((uint8_t)getRtdbPointValue(rtdbType, kDev_Type_EMS, 0, kEms_LogicLog_Enable) == 1)
|
||
{
|
||
KITLOG(LOG_MODBUS_EN, INFO_EN, "柜 %d 功率变化 %.2f kw ==> %.2f kw", loop, distPower->nowDistPower[loop], finalPower * distPower->chgDirection);
|
||
KITPTF(LOG_MODBUS_EN, INFO_EN, "柜 %d 功率变化 %.2f kw ==> %.2f kw", loop, distPower->nowDistPower[loop], finalPower * distPower->chgDirection);
|
||
}
|
||
distPower->nowDistPower[loop] = finalPower * distPower->chgDirection;
|
||
}
|
||
// 调试模式PCS开关由指令决定
|
||
if (stlogic.para_delivery.mode == E_TACTIC_MODE_DEBUG)
|
||
{
|
||
distPower->pcsSwitch[loop] = stlogic.para_delivery.task_params.debug.pcsSwitch;
|
||
}
|
||
else
|
||
{
|
||
// distPower->pcsSwitch[loop] = distPower->pcsOn; // pcs 功能码可定制 在这里
|
||
distPower->pcsSwitch[loop] = 1;
|
||
}
|
||
|
||
// 系统状态更新
|
||
updateState(kState_Discharging, true);
|
||
}
|
||
else // 待机
|
||
{
|
||
// distPower->pcsSwitch[loop] = distPower->pcsOff;
|
||
if (0 != distPower->nowDistPower[loop])
|
||
{
|
||
if ((uint8_t)getRtdbPointValue(rtdbType, kDev_Type_EMS, 0, kEms_LogicLog_Enable) == 1)
|
||
{
|
||
KITLOG(LOG_MODBUS_EN, INFO_EN, "柜 %d 功率变化 %.2f kw ==> 0 kw", loop, distPower->nowDistPower[loop]);
|
||
KITPTF(LOG_MODBUS_EN, INFO_EN, "柜 %d 功率变化 %.2f kw ==> 0 kw", loop, distPower->nowDistPower[loop]);
|
||
}
|
||
}
|
||
distPower->nowDistPower[loop] = 0;
|
||
// 调试模式PCS开关由指令决定
|
||
if (stlogic.para_delivery.mode == E_TACTIC_MODE_DEBUG)
|
||
{
|
||
distPower->pcsSwitch[loop] = stlogic.para_delivery.task_params.debug.pcsSwitch;
|
||
}
|
||
else
|
||
{
|
||
// distPower->pcsSwitch[loop] = distPower->pcsOn; // pcs 功能码可定制 在这里
|
||
distPower->pcsSwitch[loop] = 0;
|
||
}
|
||
// 系统状态更新
|
||
updateState(kState_Standby, true);
|
||
}
|
||
}
|
||
|
||
/*****************************************************************************
|
||
* @brief 期望功率分配计算并下发
|
||
*
|
||
* @return -1：数据处理失败 0：数据处理成功
|
||
*****************************************************************************/
|
||
void logicFun_powerDistr()
|
||
{
|
||
power_distr_t *charge_params = &stlogic.para_delivery.task_params.distr;
|
||
float_t tempPower = 0;
|
||
int loop = 0, closePrtc = 0;
|
||
if (charge_params == NULL)
|
||
{
|
||
// INLOG(Log_LOGIC_EN, ERROR_EN, "入参指针为空！\n");
|
||
return;
|
||
}
|
||
|
||
// 把保护计算完的的功率拿出来分配
|
||
charge_params->power = stlogic.para_delivery.task_params.protect.power;
|
||
|
||
if (E_TACTIC_MODE_DEBUG == stlogic.para_delivery.mode && stlogic.para_delivery.task_params.debug.protectSwitch)
|
||
{
|
||
closePrtc = 1;
|
||
}
|
||
// 计算每个柜子分多少功率
|
||
for (loop = 0; loop < charge_params->cabintCont; loop++)
|
||
{
|
||
if (charge_params->power < 0 && charge_params->sumSoc != 0) // 充电
|
||
{
|
||
if (closePrtc || (charge_params->pcsMaxChaPower[loop] != 0 && charge_params->pcsState[loop] != 0 && charge_params->bmsState[loop] != 0))
|
||
{
|
||
tempPower = charge_params->power * (SOCMAX - charge_params->bmsSoc[loop]) / charge_params->sumSoc;
|
||
logic_PowerCal(charge_params, tempPower, loop);
|
||
}
|
||
else
|
||
{
|
||
charge_params->nowDistPower[loop] = 0;
|
||
}
|
||
}
|
||
else if (charge_params->power > 0 && charge_params->sumSoc != 0) // 放电
|
||
{
|
||
if (closePrtc || (charge_params->pcsMaxDiscPower[loop] != 0 && charge_params->pcsState[loop] != 0 && charge_params->bmsState[loop] != 0))
|
||
{
|
||
tempPower = charge_params->power * (charge_params->bmsSoc[loop]) / charge_params->sumSoc;
|
||
logic_PowerCal(charge_params, tempPower, loop);
|
||
}
|
||
else
|
||
{
|
||
charge_params->nowDistPower[loop] = 0;
|
||
}
|
||
}
|
||
else // 待机
|
||
{
|
||
charge_params->nowDistPower[loop] = 0;
|
||
logic_PowerCal(charge_params, tempPower, loop);
|
||
}
|
||
}
|
||
}
|