/****************************************************************************** * file lib/process/pd_hf.c * author YuLiang * version 1.0.0 * date 05-March-2025 * brief This file provides all the HF operation functions. * ****************************************************************************** * Attention * *

© COPYRIGHT(c) 2025 LandPower

* * Redistribution and use in source and binary forms, with or without modification, * are permitted provided that the following conditions are met: * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of LandPower nor the names of its contributors may be used to * endorse or promote products derived from this software without specific * prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * ******************************************************************************/ /* Includes ------------------------------------------------------------------*/ #ifdef HAVE_CONFIG_H #include "config.h" #endif #ifdef CFG_DEV_TYPE_LAND_PD /* 标准C库头文件. */ #include /* 用户代码头文件. */ #include "fifo.h" #include "pd_main.h" #include "pd_csg.h" #include "pd_dau.h" #include "pd_hf.h" /* Private define ------------------------------------------------------------*/ /* Private macro -------------------------------------------------------------*/ /* Private typedef -----------------------------------------------------------*/ /* Private variables ---------------------------------------------------------*/ /* Private function prototypes -----------------------------------------------*/ /* Internal functions --------------------------------------------------------*/ /* 重启发送 */ void _hf_send_reset(uint8_t slot, void *data) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; /* 回复报文 */ head_data.cmd_type = DAU_REQUEST; head_data.cmd = DAU_C_RESET; head_data.pkt_id = dau->pkt_id++; head_data.pkt = dau->buf_send; head_data.len = sizeof(dau_pkt_head_t); dau_data_send(dau, &head_data); return; } /* 设备信息配置发送 */ void _hf_send_info_set(uint8_t slot, void *data) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; hf_dev_info_t *param = (hf_dev_info_t*)(dau->buf_send + sizeof(dau_pkt_head_t)); /* 回复报文 */ head_data.cmd_type = DAU_REQUEST; head_data.cmd = DAU_C_DEV_INFO_SET; head_data.pkt_id = dau->pkt_id++; head_data.pkt = dau->buf_send; head_data.len = sizeof(dau_pkt_head_t) + sizeof(hf_dev_info_t); memcpy(param, data, sizeof(hf_dev_info_t)); dau_data_send(dau, &head_data); return; } /* 设备信息获取发送 */ void _hf_send_info_get(uint8_t slot, void *data) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; /* 回复报文 */ head_data.cmd_type = DAU_REQUEST; head_data.cmd = DAU_C_DEV_INFO_GET; head_data.pkt_id = dau->pkt_id++; head_data.pkt = dau->buf_send; head_data.len = sizeof(dau_pkt_head_t); dau_data_send(dau, &head_data); return; } /* 设备配置发送 */ void _hf_send_cfg_set(uint8_t slot, void *data) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; hf_cfg_t *param = (hf_cfg_t*)(dau->buf_send + sizeof(dau_pkt_head_t)); /* 回复报文 */ head_data.cmd_type = DAU_PRV_REQUEST; head_data.cmd = DAU_P_CONFIG_SET; head_data.pkt_id = dau->pkt_id++; head_data.pkt = dau->buf_send; head_data.len = sizeof(dau_pkt_head_t) + sizeof(hf_cfg_t); memcpy(param, data, sizeof(hf_cfg_t)); dau_data_send(dau, &head_data); return; } /* 设备配置获取发送 */ void _hf_send_cfg_get(uint8_t slot, void *data) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; /* 回复报文 */ head_data.cmd_type = DAU_PRV_REQUEST; head_data.cmd = DAU_P_CONFIG_GET; head_data.pkt_id = dau->pkt_id++; head_data.pkt = dau->buf_send; head_data.len = sizeof(dau_pkt_head_t); dau_data_send(dau, &head_data); return; } /* 设备端口配置发送 */ void _hf_send_cfg_set_port(uint8_t slot, void *data) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; hf_cfg_port_t *param = (hf_cfg_port_t*)(dau->buf_send + sizeof(dau_pkt_head_t)); /* 回复报文 */ head_data.cmd_type = DAU_PRV_REQUEST; head_data.cmd = DAU_P_CONFIG_PORT_SET; head_data.pkt_id = dau->pkt_id++; head_data.pkt = dau->buf_send; head_data.len = sizeof(dau_pkt_head_t) + sizeof(hf_cfg_port_t); memcpy(param, data, sizeof(hf_cfg_port_t)); dau_data_send(dau, &head_data); return; } /* 设备端口配置获取发送 */ void _hf_send_cfg_get_port(uint8_t slot, void *data) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; uint8_t *param = (uint8_t*)(dau->buf_send + sizeof(dau_pkt_head_t)); /* 回复报文 */ head_data.cmd_type = DAU_PRV_REQUEST; head_data.cmd = DAU_P_CONFIG_PORT_GET; head_data.pkt_id = dau->pkt_id++; head_data.pkt = dau->buf_send; head_data.len = sizeof(dau_pkt_head_t) + 4; *param = *(uint8_t*)data; dau_data_send(dau, &head_data); return; } /* PRPS 关注报文发送 */ void _hf_send_prps_get(uint8_t slot, void *data) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; hf_prps_get_t *param = (hf_prps_get_t*)(dau->buf_send + sizeof(dau_pkt_head_t)); /* 回复报文 */ head_data.cmd_type = DAU_PRV_REQUEST; head_data.cmd = DAU_P_CONFIG_REAL_WAVE; head_data.pkt_id = dau->pkt_id++; head_data.pkt = dau->buf_send; head_data.len = sizeof(dau_pkt_head_t) + sizeof(hf_prps_get_t); memcpy(param, data, sizeof(hf_prps_get_t)); dau_data_send(dau, &head_data); return; } /* 重启报文接收 */ void _hf_recv_reset(uint8_t slot, char *pkt, uint16_t len) { hf_ack_t *ack = (hf_ack_t*)(pkt + sizeof(dau_pkt_head_t)); hf_ack_t *data = NULL; /* 申请内存 */ data = XMALLOC(MTYPE_CSG, sizeof(hf_ack_t)); if (!data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ data->result = ack->result; data->slot = slot; /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_RESET, slot, data) != E_NONE) { XFREE(MTYPE_CSG, data); } return; } /* 设备信息配置报文接收 */ void _hf_recv_info_set(uint8_t slot, char *pkt, uint16_t len) { hf_ack_t *ack = (hf_ack_t*)(pkt + sizeof(dau_pkt_head_t)); hf_ack_t *data = NULL; /* 申请内存 */ data = XMALLOC(MTYPE_CSG, sizeof(hf_ack_t)); if (!data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ data->result = ack->result; data->slot = slot; /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_INFO_SET, slot, data) != E_NONE) { XFREE(MTYPE_CSG, data); } return; } /* 设备信息配置报文接收 */ void _hf_recv_info_get(uint8_t slot, char *pkt, uint16_t len) { hf_dev_info_t *param = (hf_dev_info_t*)(pkt + sizeof(dau_pkt_head_t)); hf_dev_info_t *data = NULL; /* 申请内存 */ data = XMALLOC(MTYPE_CSG, sizeof(hf_dev_info_t)); if (!data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ memcpy(data, param, sizeof(hf_dev_info_t)); /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_INFO_GET, slot, data) != E_NONE) { XFREE(MTYPE_CSG, data); } return; } /* 心跳报文接收 */ void _hf_recv_heartbeat(uint8_t slot, char *pkt, uint16_t len) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; dau_pkt_head_t *head = (dau_pkt_head_t*)pkt; hf_heartbeat_t *data = (hf_heartbeat_t*)(pkt + sizeof(dau_pkt_head_t)); hf_data_t *hf_data = (hf_data_t*)dau->private_data; uint32_t *timestamp = (uint32_t*)(pkt + sizeof(dau_pkt_head_t)); hf_heartbeat_t *param = NULL; memcpy(&hf_data->run_status, data, sizeof(hf_heartbeat_t)); /* 回复报文 */ head_data.cmd_type = DAU_REQUEST; head_data.cmd = DAU_C_HEARTBEAT; head_data.pkt_id = head->pkt_id; head_data.pkt = pkt; head_data.len = sizeof(dau_pkt_head_t) + 4; *timestamp = time(NULL); dau_data_send(dau, &head_data); /* 将心跳计数归零 */ dau->state.beat_cnt = 0; /* 申请内存 */ param = XMALLOC(MTYPE_CSG, sizeof(hf_heartbeat_t)); if (!param) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ memcpy(param, &hf_data->run_status, sizeof(hf_heartbeat_t)); /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_HEARTBEAT, slot, param) != E_NONE) { XFREE(MTYPE_CSG, param); } return; } /* 设备配置报文接收 */ void _hf_recv_cfg_set(uint8_t slot, char *pkt, uint16_t len) { hf_ack_t *ack = (hf_ack_t*)(pkt + sizeof(dau_pkt_head_t)); hf_ack_t *data = NULL; /* 申请内存 */ data = XMALLOC(MTYPE_CSG, sizeof(hf_ack_t)); if (!data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ data->result = ack->result; data->slot = slot; /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_CFG_SET, slot, data) != E_NONE) { XFREE(MTYPE_CSG, data); } return; } /* 设备配置报文接收 */ void _hf_recv_cfg_get(uint8_t slot, char *pkt, uint16_t len) { dau_t *dau = &daus[slot]; hf_data_t *hf_data = (hf_data_t*)dau->private_data; hf_cfg_t *param = (hf_cfg_t*)(pkt + sizeof(dau_pkt_head_t)); hf_cfg_t *data = NULL; memcpy(&hf_data->cfg, param, sizeof(hf_cfg_t)); /* 申请内存 */ data = XMALLOC(MTYPE_CSG, sizeof(hf_cfg_t)); if (!data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ memcpy(data, &hf_data->cfg, sizeof(hf_cfg_t)); /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_CFG_GET, slot, data) != E_NONE) { XFREE(MTYPE_CSG, data); } return; } /* 设备端口配置报文接收 */ void _hf_recv_cfg_set_port(uint8_t slot, char *pkt, uint16_t len) { hf_cfg_port_ack_t *ack = (hf_cfg_port_ack_t*)(pkt + sizeof(dau_pkt_head_t)); hf_cfg_port_ack_t *data = NULL; /* 申请内存 */ data = XMALLOC(MTYPE_CSG, sizeof(hf_cfg_port_ack_t)); if (!data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ data->vport = ack->vport; data->result = ack->result; data->slot = slot; /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_PORT_SET, slot, data) != E_NONE) { XFREE(MTYPE_CSG, data); } return; } /* 设备端口配置报文接收 */ void _hf_recv_cfg_get_port(uint8_t slot, char *pkt, uint16_t len) { dau_t *dau = &daus[slot]; hf_data_t *hf_data = (hf_data_t*)dau->private_data; hf_cfg_port_t *param = (hf_cfg_port_t*)(pkt + sizeof(dau_pkt_head_t)); hf_cfg_port_t *data = NULL; uint8_t port = 0; port = param->vport - 1; memcpy(&hf_data->port[port], param, sizeof(hf_cfg_port_t)); /* 申请内存 */ data = XMALLOC(MTYPE_CSG, sizeof(hf_cfg_port_t)); if (!data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ memcpy(data, &hf_data->port[port], sizeof(hf_cfg_port_t)); /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_PORT_GET, slot, data) != E_NONE) { XFREE(MTYPE_CSG, data); } return; } /* PRPS 关注报文接收 */ void _hf_recv_prps_get(uint8_t slot, char *pkt, uint16_t len) { hf_ack_t *ack = (hf_ack_t*)(pkt + sizeof(dau_pkt_head_t)); hf_ack_t *data = NULL; /* 申请内存 */ data = XMALLOC(MTYPE_CSG, sizeof(hf_ack_t)); if (!data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } /* 装填数据 */ data->result = ack->result; data->slot = slot; /* 发送给后台 */ if (dau_msg_send_cmd(DAU_SEND_PRPS_GET, slot, data) != E_NONE) { XFREE(MTYPE_CSG, data); } return; } /* 趋势报文接收 */ void _hf_recv_trend(uint8_t slot, char *pkt, uint16_t len) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; hf_data_t *hf_data = (hf_data_t*)dau->private_data; hf_trend_t *trend = &hf_data->trend; dau_pkt_head_t *head = (dau_pkt_head_t*)pkt; hf_trend_head_t *head_trend = (hf_trend_head_t*)(pkt + sizeof(dau_pkt_head_t)); char *data = (char*)(pkt + sizeof(dau_pkt_head_t) + sizeof(hf_trend_head_t)); char *point = NULL; uint8_t port = 0; hf_trend_ack_t ack; hf_trend_ack_t *ack_p = (hf_trend_ack_t*)(pkt + sizeof(dau_pkt_head_t)); /* 不处理补包数据 */ if (!head_trend->boosterpack) { //printh("#1 %d %d %d %d\r\n", head_trend->vport, head_trend->sum, head_trend->index, head_trend->type); //printh("#2 %d %d\r\n", head_trend->utc, head_trend->len); port = head_trend->vport - 1; if (HF_TREND_TYPE_STAT == head_trend->type) { trend->col.index = head_trend->identifier; trend->col.utc = head_trend->utc; memcpy(&trend->col.port[port], data, sizeof(hf_trend_stat)); if ((head_trend->index + 1) == head_trend->sum) { //printh("vport %d index %d utc %d max %d\r\n", head_trend->vport, trend->col.index, trend->col.utc, trend->col.port[port].max); //printh("avg %d cnt %d phase %d noise %d\r\n", trend->col.port[port].avg, trend->col.port[port].cnt, trend->col.port[port].phase, trend->col.port[port].noise); //printh("event_cnt %d\r\n", trend->col.port[port].event_cnt); } } else if (HF_TREND_TYPE_PRPD == head_trend->type) { point = (char*)trend->prpd.port[port].data; point += head_trend->index * HF_DATA_LEN; memcpy(point, data, head_trend->len); } else if (HF_TREND_TYPE_PRPS == head_trend->type) { if (0 == head_trend->index) { trend->prps.port[port].point_cnt = 0; } /* 这里左移 2 位是因为 sizeof(hf_data_point_t) 等于 4 */ trend->prps.port[port].point_cnt += head_trend->len >> 2; point = (char*)trend->prps.port[port].point; point += head_trend->index * HF_DATA_LEN; memcpy(point, data, head_trend->len); } } /* 回复报文 */ head_data.cmd_type = DAU_PRV_REQUEST; head_data.cmd = DAU_P_TREND; head_data.pkt_id = head->pkt_id; head_data.pkt = pkt; head_data.len = sizeof(dau_pkt_head_t) + sizeof(hf_trend_ack_t); ack.index = head_trend->index; ack.result = 0; ack.boosterpack = head_trend->boosterpack; memcpy(ack_p, &ack, sizeof(hf_trend_ack_t)); dau_data_send(dau, &head_data); return; } /* PRPS 图谱接收 */ void _hf_recv_prps(uint8_t slot, char *pkt, uint16_t len) { dau_t *dau = &daus[slot]; hf_data_t *hf_data = (hf_data_t*)dau->private_data; hf_prps_t *prps = &hf_data->prps; hf_prps_t *prps_send = NULL; hf_prps_head_t *head_prps = (hf_prps_head_t*)(pkt + sizeof(dau_pkt_head_t)); char *data = (char*)(pkt + sizeof(dau_pkt_head_t) + sizeof(hf_prps_head_t)); char *point = NULL; /* 第一个报文 */ if (0 == head_prps->pkt_index) { memcpy(&prps->head, head_prps, sizeof(hf_prps_head_t)); } point = (char*)prps->prps; point += head_prps->pkt_index * HF_DATA_LEN; memcpy(point, data, head_prps->len); if ((head_prps->pkt_index + 1) == head_prps->pkt_sum) { /* 申请内存 */ prps_send = XMALLOC_Q(MTYPE_CSG, sizeof(hf_prps_t)); if (!prps_send) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return; } memcpy(prps_send, prps, sizeof(hf_prps_t)); /* 发送给后台, 内存由后台释放 */ if (dau_msg_send(DAU_SEND_PRPS, slot, prps_send) != E_NONE) { return; } } return; } /* 事件报文接收 */ void _hf_recv_event(uint8_t slot, char *pkt, uint16_t len) { dau_head_init_t head_data; dau_t *dau = &daus[slot]; hf_data_t *hf_data = (hf_data_t*)dau->private_data; hf_event_t *event = &hf_data->event; dau_pkt_head_t *head = (dau_pkt_head_t*)pkt; hf_event_head_t *head_event = (hf_event_head_t*)(pkt + sizeof(dau_pkt_head_t)); char *data = (char*)(pkt + sizeof(dau_pkt_head_t) + sizeof(hf_event_head_t)); char *point = NULL; hf_event_ack_t ack; hf_event_ack_t *ack_p = (hf_event_ack_t*)(pkt + sizeof(dau_pkt_head_t)); /* 不处理补包数据 */ if (!head_event->boosterpack) { //printh("#3 %d %d %d %d\r\n", head_event->vport, head_event->sum, head_event->index, head_event->type); //printh("#4 %d %d\r\n\n", head_event->utc, head_event->len); /* 第一个报文 */ if (0 == head_event->index) { event->head.vport = head_event->vport; event->head.boosterpack = head_event->boosterpack; event->head.power_fre = head_event->power_fre; event->head.type = head_event->type; event->head.max = head_event->max; event->head.identifier = head_event->identifier; event->head.utc = head_event->utc; event->head.cnt = head_event->cnt; event->head.avg_o = head_event->avg_o; event->head.avg = head_event->avg; event->head.point_cnt = head_event->point_cnt; } point = (char*)event->point; point += head_event->index * HF_DATA_LEN; memcpy(point, data, head_event->len); if ((head_event->index + 1) == head_event->sum) { //printh("vport %d power_fre %d type %d max %d\r\n", event->head.vport, event->head.power_fre, event->head.type, event->head.max); //printh("identifier %d utc %d cnt %d avg %d\r\n", event->head.identifier, event->head.utc, event->head.cnt, event->head.avg); //printh("point_cnt %d\r\n\n", event->head.point_cnt); } } /* 回复报文 */ head_data.cmd_type = DAU_PRV_REQUEST; head_data.cmd = DAU_P_EVENT; head_data.pkt_id = head->pkt_id; head_data.pkt = pkt; head_data.len = sizeof(dau_pkt_head_t) + sizeof(hf_event_ack_t); ack.index = head_event->index; ack.result = 0; ack.boosterpack = head_event->boosterpack; memcpy(ack_p, &ack, sizeof(hf_event_ack_t)); dau_data_send(dau, &head_data); return; } /* 校验收到包的包头, 长度, 校验码. */ int32_t _hf_pkt_check(uint8_t slot, char *pkt) { dau_t *dau = &daus[slot]; dau_pkt_head_t *head = (dau_pkt_head_t*)pkt; /* 对主次设备号进行识别, 次设备号可以是广播. */ if (head->dev_type_m != dau->info.type_m || head->dev_type_s != dau->info.type_s) { DBG(DBG_M_PD_HF_ERR, "Device type %d:%d ERROR\r\n", head->dev_type_m, head->dev_type_s); return E_ERROR; } if (head->dev_id != dau->info.dev_id) { DBG(DBG_M_PD_HF_ERR, "Device id %08x ERROR\r\n", head->dev_id); return E_ERROR; } if (head->len > DAU_BUF_SIZE) { DBG(DBG_M_PD_HF_ERR, "Packet len %d ERROR\r\n", head->len); return E_ERROR; } if ((DAU_REPLY == head->cmd_type && head->cmd >= DAU_C_MAX) || (DAU_PRV_REPLY == head->cmd_type && head->cmd >= DAU_P_MAX)) { DBG(DBG_M_PD_HF_ERR, "Cmd %d:%d ERROR\r\n", head->cmd_type, head->cmd); return E_ERROR; } return E_NONE; } /* 命令映射表 */ static hf_recv_fun_cb _hf_command[] = { NULL, // 0 NULL, // DAU_C_CONTACT 1 NULL, // DAU_C_ADD_DAU 2 _hf_recv_reset, // DAU_C_RESET 3 NULL, // 4 NULL, // DAU_C_UPDATE 5 _hf_recv_info_set, // DAU_C_DEV_INFO_SET 6 _hf_recv_info_get, // DAU_C_DEV_INFO_GET 7 NULL, // 8 NULL, // DAU_C_UPDATE_RESULT 9 _hf_recv_heartbeat, // DAU_C_HEARTBEAT 10 }; /* 命令映射表 */ static hf_recv_fun_cb _hf_prv_command[] = { NULL, // 0 _hf_recv_cfg_set, // DAU_P_CONFIG_SET 1 _hf_recv_cfg_get, // DAU_P_CONFIG_GET 2 _hf_recv_cfg_set_port, // DAU_P_CONFIG_PORT_SET 3 _hf_recv_cfg_get_port, // DAU_P_CONFIG_PORT_GET 4 _hf_recv_prps_get, // DAU_P_CONFIG_REAL_WAVE 5 NULL, // 6 NULL, // 7 NULL, // 8 NULL, // 9 _hf_recv_trend, // DAU_P_TREND 10 _hf_recv_prps, // DAU_P_REAL_PRPS 11 _hf_recv_event, // DAU_P_EVENT 12 }; /* 命令映射表 */ static hf_send_fun_cb _hf_send_command[] = { NULL, // 0 NULL, // DAU_SEND_ADD 1 _hf_send_reset, // DAU_SEND_RESET 2 NULL, // 3 _hf_send_info_set, // DAU_SEND_INFO_SET 4 _hf_send_info_get, // DAU_SEND_INFO_GET 5 NULL, // 6 NULL, // DAU_SEND_HEARTBEAT 7 _hf_send_cfg_set, // DAU_SEND_CFG_SET 8 _hf_send_cfg_get, // DAU_SEND_CFG_GET 9 _hf_send_cfg_set_port, // DAU_SEND_PORT_SET 10 _hf_send_cfg_get_port, // DAU_SEND_PORT_GET 11 _hf_send_prps_get, // DAU_SEND_PRPS_GET 12 NULL, // 13 NULL, // DAU_SEND_PRPS 14 NULL, // 15 }; /* Interface functions -------------------------------------------------------*/ /* 高频收包处理函数 */ int32_t hf_recv_process(uint8_t slot, char *pkt, uint16_t len) { dau_pkt_head_t *head = (dau_pkt_head_t*)pkt; /* 报文头和 CRC 校验. */ LD_E_RETURN_N(_hf_pkt_check(slot, pkt)); if (DAU_REPLY == head->cmd_type) { if (_hf_command[head->cmd]) { _hf_command[head->cmd](slot, pkt, len); } } else if (CSG_PRV_REPLY == head->cmd_type) { if (_hf_prv_command[head->cmd]) { _hf_prv_command[head->cmd](slot, pkt, len); } } return E_NONE; } /* 高频发包处理函数 */ int32_t hf_send_process(uint8_t slot, uint8_t type, void *data) { if (_hf_send_command[type]) { _hf_send_command[type](slot, data); } return E_NONE; } /* 高频私有数据 */ void* hf_data_malloc(uint8_t slot) { dau_t *dau = &daus[slot]; hf_data_t *p = (hf_data_t*)dau->private_data; /* 申请新内存 */ dau->private_data = XMALLOC_Q(MTYPE_HF, sizeof(hf_data_t)); if (!dau->private_data) { DBG(DBG_M_PD_HF_ERR, "XMALLOC ERROR!\r\n"); return NULL; } /* 释放旧内存 */ if (p) { XFREE(MTYPE_HF, p); } p = (hf_data_t*)dau->private_data; memset(&p->cfg, 0, sizeof(hf_cfg_t)); memset(&p->port, 0, sizeof(hf_cfg_port_t) * PD_DAU_PORT_SUM); return p; } /* 显示全局配置 */ void hf_show_cfg(uint8_t slot) { hf_data_t *hf_data = (hf_data_t*)daus[slot].private_data; hf_cfg_t *cfg = &hf_data->cfg; dau_send_msg_t msg; msg.type = DAU_SEND_CFG_GET; msg.data = XMALLOC_Q(MTYPE_CSG, 4); fifo_write(daus[slot].fifo_send, &msg, sizeof(dau_send_msg_t)); sleep(1); printh("Power frequency: %fHz\r\n", cfg->power_frequency / 10.0); printh("Trend period: %dm\r\n", cfg->trend_period); printh("Sync mode: %s\r\n", pd_sync_str[cfg->sync_mode]); printh("Heartbeat period: %dm\r\n", cfg->heartbeat_period); printh("PPS mode: %s\r\n", pd_pps_str[cfg->pps_mode]); printh("Protocol type: %s\r\n", pd_protocol_str[cfg->protocol_type]); printh("Trend storage: %d\r\n", cfg->trend_storage); printh("Event storage: %d\r\n\n", cfg->event_storage); return; } /* 显示端口配置 */ void hf_show_port(uint8_t slot, uint8_t port) { hf_data_t *hf_data = (hf_data_t*)daus[slot].private_data; hf_cfg_port_t *cfg = &hf_data->port[port]; dau_send_msg_t msg; msg.type = DAU_SEND_PORT_GET; msg.data = XMALLOC_Q(MTYPE_CSG, 4); *(uint8_t*)msg.data = port + 1; fifo_write(daus[slot].fifo_send, &msg, sizeof(dau_send_msg_t)); sleep(1); printh("Port type: %s\r\n", dau_port_type_str[cfg->port_type]); printh("Auto noise: %s\r\n", cfg->is_auto_noise ? "true" : "false"); printh("Denoise type: %s\r\n", pd_noise_type_str[cfg->denoise_type]); printh("Denoise level: %dmv\r\n", cfg->denoise_auto); printh("Denoise manual: %dmv\r\n", cfg->denoise_manual); printh("Event cnt high: sum %d sec %d\r\n", cfg->event_counter_h, cfg->event_sec_h); printh("Event thr high: thr %d sum %d\r\n", cfg->event_thr_h, cfg->event_counter_thr_h); printh("Event cnt low: sum %d sec %d thr %d sum %d\r\n\n", cfg->event_counter_l, cfg->event_sec_l, cfg->event_thr_l, cfg->event_counter_thr_l); return; } #endif /************************ (C) COPYRIGHT LandPower ***** END OF FILE ****************/