/******************************************************************************
* 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 "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 -----------------------------------------------*/
extern void _hf_heartbeat_recv(uint8_t slot, char *pkt, uint16_t len);
extern void _hf_prps_get_recv(uint8_t slot, char *pkt, uint16_t len);
extern void _hf_trend_recv(uint8_t slot, char *pkt, uint16_t len);
extern void _hf_event_recv(uint8_t slot, char *pkt, uint16_t len);
extern void _hf_prps_get_send(uint8_t slot, void *data);
// 命令映射表
static dau_recv_fun_cb _hf_command[] =
{
NULL, // 0
NULL, // DAU_C_CONTACT 1
NULL, // DAU_C_ADD_DAU 2
NULL, // DAU_C_RESET 3
NULL, // 4
NULL, // DAU_C_UPDATE 5
NULL, // DAU_C_DEV_INFO_SET 6
NULL, // DAU_C_DEV_INFO_GET 7
NULL, // 8
NULL, // DAU_C_UPDATE_RESULT 9
_hf_heartbeat_recv, // DAU_C_HEARTBEAT 10
};
// 命令映射表
static dau_recv_fun_cb _hf_prv_command[] =
{
NULL, // 0
NULL, // DAU_P_CONFIG_SET 1
NULL, // DAU_P_CONFIG_GET 2
NULL, // DAU_P_CONFIG_PORT_SET 3
NULL, // DAU_P_CONFIG_PORT_GET 4
_hf_prps_get_recv, // DAU_P_CONFIG_REAL_WAVE 5
NULL, // 6
NULL, // 7
NULL, // 8
NULL, // 9
_hf_trend_recv, // DAU_P_TREND 10
NULL, // DAU_P_REAL_PRPS 11
_hf_event_recv, // DAU_P_EVENT 12
};
// 命令映射表
static dau_send_fun_cb _hf_send_command[] =
{
NULL, // 0
_hf_prps_get_send, // DAU_SEND_PRPS 1
};
/* Interface functions -------------------------------------------------------*/
/* PRPS 关注报文发送 */
void _hf_prps_get_send(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_send_data(dau, &head_data);
return;
}
/* 心跳报文接收 */
void _hf_heartbeat_recv(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));
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_send_data(dau, &head_data);
return;
}
/* 心跳报文接收 */
void _hf_prps_get_recv(uint8_t slot, char *pkt, uint16_t len)
{
return;
}
/* 趋势报文接收 */
void _hf_trend_recv(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_send_data(dau, &head_data);
return;
}
/* 事件报文接收 */
void _hf_event_recv(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;
}
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);
}
point = (char*)event->point;
point += head_event->index * HF_DATA_LEN;
memcpy(point, data, head_event->len);
}
/* 回复报文 */
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_send_data(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;
}
/* 高频收包处理函数 */
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(void)
{
return XMALLOC_Q(MTYPE_HF, sizeof(hf_data_t));
}
#endif
/************************ (C) COPYRIGHT LandPower ***** END OF FILE ****************/