385 lines
12 KiB
C
385 lines
12 KiB
C
/*****************************************************************************
|
||
* @copyright 2024-202, . POWER SUPPLY CO., LTD.
|
||
* @file logic_main.c
|
||
* @brief xxxx
|
||
* @author Gary
|
||
* @date 2024/09/29
|
||
* @remark 初修订
|
||
*****************************************************************************/
|
||
#include "logic_main.h"
|
||
|
||
logic_pthread_t stlogic = {0};
|
||
tast_register_execute *task_group[E_TACTIC_MODE_END] = {0}; // MAX_TASK_NUM改用枚举
|
||
|
||
// 用于log打印 与 work_mode_e 强绑定
|
||
const char *workModeNames[] = {
|
||
"无",
|
||
"调试模式",
|
||
"削峰填谷模式",
|
||
"需求响应模式",
|
||
"负载跟踪模式",
|
||
"需量控制",
|
||
"功率因数",
|
||
"null"};
|
||
|
||
/*********************************************************************
|
||
* @brief 初始化任务参数
|
||
* @param[in] 无
|
||
* @return 0：sucessful；1：fault
|
||
*********************************************************************/
|
||
static int initTaskParam()
|
||
{
|
||
logic_getProtectParam();
|
||
|
||
logic_getPowerDistrParam();
|
||
|
||
work_mode_set_t tempMode;
|
||
if (0 == kit_get_work_mode_set(&tempMode))
|
||
{
|
||
stlogic.para_delivery.mode = tempMode.workMode;
|
||
}
|
||
else if ((uint8_t)getRtdbPointValue(rtdbType, kDev_Type_EMS, 0, kEms_LogicLog_Enable) == 1)
|
||
{
|
||
KITLOG(LOG_MODBUS_EN, INFO_EN, "获取调试配置失败 %s ==> %s", workModeNames[stlogic.para_delivery.mode], workModeNames[tempMode.workMode]);
|
||
KITPTF(LOG_MODBUS_EN, INFO_EN, "获取调试配置失败 %s ==> %s", workModeNames[stlogic.para_delivery.mode], workModeNames[tempMode.workMode]);
|
||
return 1;
|
||
}
|
||
else
|
||
{
|
||
return 1;
|
||
}
|
||
|
||
// 读取参数值
|
||
switch (stlogic.para_delivery.mode)
|
||
{
|
||
case E_TACTIC_MODE_DEBUG: // 调试模式
|
||
logic_debugParamUpdate();
|
||
break;
|
||
case E_TACTIC_MODE_PEAKVALLY: // 削峰填谷模式
|
||
logic_peakValleyUpdate();
|
||
break;
|
||
case E_TACTIC_MODE_DEMANDRES: // 需求响应模式
|
||
/* 暂未实现 */
|
||
break;
|
||
case E_TACTIC_MODE_LOADTRACK: // 负载跟踪模式
|
||
/* 暂未实现 */
|
||
break;
|
||
case E_TACTIC_MODE_DMDCTRL: // 需量控制模式
|
||
/* 暂未实现 */
|
||
break;
|
||
case E_TACTIC_MODE_PFCTRL: // 功率因数模式
|
||
/* 暂未实现 */
|
||
break;
|
||
default:
|
||
/*无模式*/
|
||
break;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @brief 注册并初始化一个新的任务节点
|
||
* @param[in] task_func 任务的函数指针
|
||
* @return 成功时返回指向新任务节点的指针；失败时返回 NULL
|
||
*********************************************************************/
|
||
// 初始化任务链表节点
|
||
tast_register_execute *register_task(task_func_t task_func)
|
||
{
|
||
tast_register_execute *new_task = (tast_register_execute *)malloc(sizeof(tast_register_execute));
|
||
if (new_task == NULL)
|
||
{
|
||
printf("Memory allocation failed!\n");
|
||
return NULL;
|
||
}
|
||
// new_task->taskPeriod = period;
|
||
new_task->task = task_func;
|
||
new_task->next = NULL;
|
||
return new_task;
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @brief 初始化任务链表，支持多个任务函数指针
|
||
* @param[in] count 任务数量
|
||
* @param[in] ... 可变参数，任务函数指针
|
||
* @return 成功时返回指向链表头部的指针；失败时返回 NULL
|
||
*********************************************************************/
|
||
tast_register_execute *init_task_list(int count, ...)
|
||
{
|
||
if (count <= 0)
|
||
return NULL; // 确保任务数量合法
|
||
|
||
va_list args; // 用于处理可变参数
|
||
va_start(args, count); // 初始化可变参数列表
|
||
|
||
tast_register_execute *head = NULL, *current = NULL;
|
||
|
||
// 循环遍历每个任务函数
|
||
for (int i = 0; i < count; i++)
|
||
{
|
||
task_func_t task_func = va_arg(args, task_func_t); // 获取当前任务函数指针
|
||
tast_register_execute *new_task = register_task(task_func);
|
||
if (new_task == NULL)
|
||
{
|
||
// 内存分配失败时，清理已分配的节点并返回 NULL
|
||
// free_task_list(head);
|
||
va_end(args); // 清理可变参数列表
|
||
return NULL;
|
||
}
|
||
|
||
if (head == NULL)
|
||
{
|
||
// 第一个任务作为头节点
|
||
head = new_task;
|
||
}
|
||
else
|
||
{
|
||
// 将新任务链接到链表末尾
|
||
current->next = new_task;
|
||
}
|
||
current = new_task; // 更新当前任务
|
||
}
|
||
|
||
va_end(args); // 结束可变参数处理
|
||
return head;
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @brief 初始化任务注册信息
|
||
* @param[in] 无
|
||
* @return 0：sucessful；1：fault
|
||
*********************************************************************/
|
||
static int logic_initTaskRegister()
|
||
{
|
||
INIT_TASK_GROUP();
|
||
|
||
for (int i = 0; i < E_TACTIC_MODE_END; i++)
|
||
{
|
||
if (task_group[i] == NULL)
|
||
{
|
||
printf("Failed to initialize task group 0.\n");
|
||
return 1; // 错误返回
|
||
}
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @brief 创建任务线程
|
||
* @param[in] 无
|
||
* @return 无
|
||
*********************************************************************/
|
||
static int creatLogicTaskEntry()
|
||
{
|
||
if (pthread_create(&stlogic.tfd, NULL, creatLogicTaskThread, (void *)&stlogic.para_delivery) == 0)
|
||
{
|
||
KITPTF(LOG_LOGIC_EN, INFO_EN, "task线程创建成功");
|
||
KITLOG(LOG_LOGIC_EN, INFO_EN, "task线程创建成功");
|
||
return 0;
|
||
}
|
||
else
|
||
{
|
||
return 1;
|
||
}
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @brief 新建任务模块的初始化工作
|
||
* @param[in] 无
|
||
* @return 0：sucessful；1：fault
|
||
*********************************************************************/
|
||
int creatLogicCtrTaskEntry()
|
||
{
|
||
initTaskParam();
|
||
|
||
if (logic_initTaskRegister() != 0)
|
||
{
|
||
return 1;
|
||
}
|
||
|
||
if (creatLogicTaskEntry() != 0)
|
||
{
|
||
return 1;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @brief 任务触发,读取数据库入参
|
||
* @param[in] 无
|
||
* @return
|
||
*********************************************************************/
|
||
void logic_taskTrigger()
|
||
{
|
||
int modeChange = 0;
|
||
// 读取是否参数更新
|
||
for (u_int16_t i = kSign_Logic_Start; i < kSign_Logic_End; i++)
|
||
{
|
||
stlogic.para_delivery.ParaChangeSign.ParaChangeUnion |= ((readWebSign(kSign_ShMem, i) == LOGIC_SIGN_MESSAGE) << i);
|
||
}
|
||
|
||
// 读取是否切换模式
|
||
if (LOGIC_SIGN_MESSAGE == readWebSign(kSign_ShMem, kSign_LogicMode))
|
||
{
|
||
writeWebSign(kSign_ShMem, kSign_LogicMode, 0);
|
||
modeChange = 1;
|
||
work_mode_set_t tempMode;
|
||
if (0 != kit_get_work_mode_set(&tempMode))
|
||
{
|
||
if ((uint8_t)getRtdbPointValue(rtdbType, kDev_Type_EMS, 0, kEms_LogicLog_Enable) == 1)
|
||
{
|
||
KITLOG(LOG_LOGIC_EN, INFO_EN, "获取调试配置失败 模式切换失败！！！ %s ==> %s",workModeNames[stlogic.para_delivery.mode],workModeNames[tempMode.workMode]);
|
||
KITPTF(LOG_LOGIC_EN, INFO_EN, "获取调试配置失败 模式切换失败！！！ %s ==> %s",workModeNames[stlogic.para_delivery.mode],workModeNames[tempMode.workMode]);
|
||
return;
|
||
}
|
||
}
|
||
if ((uint8_t)getRtdbPointValue(rtdbType, kDev_Type_EMS, 0, kEms_LogicLog_Enable) == 1)
|
||
{
|
||
KITLOG(LOG_LOGIC_EN, INFO_EN, "模式切换 %s ==> %s",workModeNames[stlogic.para_delivery.mode],workModeNames[tempMode.workMode]);
|
||
KITPTF(LOG_LOGIC_EN, INFO_EN, "模式切换 %s ==> %s",workModeNames[stlogic.para_delivery.mode],workModeNames[tempMode.workMode]);
|
||
return;
|
||
}
|
||
stlogic.para_delivery.mode = tempMode.workMode;
|
||
}
|
||
|
||
stlogic.para_delivery.task_params.protect.protectSign = (readWebSign(kSign_ShMem, kSign_Protect) == LOGIC_SIGN_MESSAGE);
|
||
stlogic.para_delivery.task_params.distr.powerSign = (readWebSign(kSign_ShMem, kSign_ActivePower) == LOGIC_SIGN_MESSAGE);
|
||
|
||
//数据库获取参数
|
||
/****保护****/
|
||
if (LOGIC_SIGN_MESSAGE == stlogic.para_delivery.task_params.protect.protectSign)
|
||
{
|
||
if (1 == logic_getProtectParam())
|
||
{
|
||
KITLOG(LOG_LOGIC_EN, INFO_EN, "保护参数错误");
|
||
KITPTF(LOG_LOGIC_EN, INFO_EN, "保护参数错误");
|
||
return;
|
||
}
|
||
stlogic.para_delivery.task_params.protect.protectSign = LOGIC_SIGN_UPLOAD;
|
||
}
|
||
|
||
/****功率分配****/
|
||
if (LOGIC_SIGN_MESSAGE == stlogic.para_delivery.task_params.distr.powerSign)
|
||
{
|
||
if (1 == logic_getPowerDistrParam())
|
||
{
|
||
KITLOG(LOG_LOGIC_EN, INFO_EN, "分配参数错误");
|
||
KITPTF(LOG_LOGIC_EN, INFO_EN, "分配参数错误");
|
||
return;
|
||
}
|
||
// 成功读完清除标志
|
||
stlogic.para_delivery.task_params.distr.powerSign = LOGIC_SIGN_UPLOAD;
|
||
}
|
||
|
||
//判定是否模式和参数统一
|
||
switch (stlogic.para_delivery.mode)
|
||
{
|
||
case E_TACTIC_MODE_DEBUG: // 调试模式
|
||
if (stlogic.para_delivery.ParaChangeSign.bits.debug || modeChange)
|
||
{
|
||
writeWebSign(kSign_ShMem, kSign_LogicDebug, LOGIC_SIGN_NONE);
|
||
if (1 == logic_debugParamUpdate())
|
||
{
|
||
KITLOG(LOG_LOGIC_EN, INFO_EN, "调试参数错误");
|
||
KITPTF(LOG_LOGIC_EN, INFO_EN, "调试参数错误");
|
||
}
|
||
// 成功读完清除标志
|
||
stlogic.para_delivery.ParaChangeSign.bits.debug = LOGIC_SIGN_NONE;
|
||
}
|
||
break;
|
||
case E_TACTIC_MODE_PEAKVALLY: // 削峰填谷模式
|
||
if (stlogic.para_delivery.ParaChangeSign.bits.peakValley || modeChange)
|
||
{
|
||
writeWebSign(kSign_ShMem, kSign_LogicPeakValley, LOGIC_SIGN_NONE);
|
||
if (1 == logic_peakValleyUpdate())
|
||
{
|
||
KITLOG(LOG_LOGIC_EN, INFO_EN, "削峰填谷参数错误");
|
||
KITPTF(LOG_LOGIC_EN, INFO_EN, "削峰填谷参数错误");
|
||
}
|
||
// 成功读完清除标志
|
||
stlogic.para_delivery.ParaChangeSign.bits.peakValley = LOGIC_SIGN_NONE;
|
||
}
|
||
break;
|
||
|
||
case E_TACTIC_MODE_DEMANDRES: // 需求响应模式
|
||
/* 暂未实现 */
|
||
|
||
break;
|
||
case E_TACTIC_MODE_LOADTRACK: // 负载跟踪模式
|
||
/* 暂未实现 */
|
||
|
||
break;
|
||
case E_TACTIC_MODE_DMDCTRL: // 需量控制
|
||
/* 暂未实现 */
|
||
|
||
break;
|
||
case E_TACTIC_MODE_PFCTRL: // 功率因数
|
||
/* 暂未实现 */
|
||
|
||
break;
|
||
default:
|
||
/*无模式*/
|
||
stlogic.para_delivery.task_params.distr.power = 0;
|
||
stlogic.para_delivery.task_params.protect.power = 0;
|
||
break;
|
||
}
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @brief 调度函数，根据收到的指令执行对应任务链
|
||
* @param[in] task_param 任务参数
|
||
* @return 0: 成功, 1: 错误（如索引无效）
|
||
*********************************************************************/
|
||
int logic_taskExe(work_mode_e mode)
|
||
{
|
||
if (mode >= E_TACTIC_MODE_END)
|
||
{
|
||
// printf("Invalid task group index!\n");
|
||
return 1; // 返回错误
|
||
}
|
||
|
||
tast_register_execute *current = task_group[mode];
|
||
|
||
// 遍历并执行任务链表中的所有任务
|
||
while (current != NULL)
|
||
{
|
||
current->task(); // 执行当前任务
|
||
current = current->next; // 移动到下一个任务
|
||
}
|
||
|
||
return 0; // 成功
|
||
}
|
||
|
||
/*****************************************************************************
|
||
* @brief 创建任务调度线程
|
||
* @param[in] 无
|
||
* @return 无
|
||
*****************************************************************************/
|
||
void *creatLogicTaskThread(void *arg)
|
||
{
|
||
task_params_t *task_param_in = (task_params_t *)arg;
|
||
while (stlogic.exitTaskFlag == 0)
|
||
{
|
||
logic_taskTrigger();
|
||
logic_getRTDBParams();
|
||
if (0 != logic_taskExe(task_param_in->mode))
|
||
{
|
||
// 处理调度错误，可以记录日志
|
||
KITLOG(LOG_LOGIC_EN, ERROR_EN, "任务调度失败，参数无效");
|
||
usleep(50000); // 50ms sleep
|
||
continue;
|
||
}
|
||
logic_paramUpload();
|
||
|
||
usleep(20000); // 20ms sleep
|
||
}
|
||
|
||
pthread_exit(NULL);
|
||
}
|
||
|
||
void example_task1()
|
||
{
|
||
;
|
||
}
|