Files
STM32F4-Base/IEC60870-Slave/common/IEC60870_FaultEvent.c
T
STF bdcc8b6500
CI / L0 静态门禁 (pre-commit) (push) Failing after 7m46s
CI / L0.5 主机侧单测 (MSVC) (push) Successful in 21s
添加遥控、参数装载、文件传输等业务
2026-11-16 22:19:17 -08:00

349 lines
18 KiB
C
Raw Blame History

This file contains ambiguous Unicode characters
This file contains Unicode characters that might be confused with other characters. If you think that this is intentional, you can safely ignore this warning. Use the Escape button to reveal them.
/*
* Type42故障事件信息完整ASDU:两组异构记录共用链路IOA宽度,计数位于报文体。
* 此处采用故障事件扩展布局,不属于基础IEC标准定义的Type42对象。
* 两组记录分别携带数量和类型,不能在首记录前补普通外层IOA或在遥测值后补QDS。
* 编码先验证全部输入和容量,再写入;解析先验证整帧,再发布借用视图。
* 本模块只负责冻结简报的字节契约;故障判据、连续录波与上送先后分别由调用方组织,
* 不能用本模块的编码成功推断故障已经送达,或推断相应录波文件已经可靠保存。
*/
#include "IEC60870_FaultEvent.h"
#include "IEC60870_InformationObjects_Internal.h"
#include <float.h>
#include <math.h>
#include <string.h>
/* 后续memcpy只转换位模式,不转换数值格式;编译期先确认宿主float就是所需binary32。 */
_Static_assert(sizeof(float) == sizeof(uint32_t) && FLT_RADIX == 2 &&
FLT_MANT_DIG == 24 && FLT_MAX_EXP == 128, "Fault event requires binary32 float");
/**
* 功能:计算ASDU公共头长度,不含APCI或任何IOA。
* 输入参数:已验证的parameters
* 输出参数:无
* 返回值:2+COT宽度+CA宽度。
* 说明:前提:调用方已通过AppLayerParameters_Valid,固定2字节分别为TI和VSQ。
*/
static unsigned int Fault_Event_Header_Size(const IEC60870_AppLayerParameters_t *parameters)
{
return (unsigned int)(2 + parameters->sizeOfCOT + parameters->sizeOfCA);
}
/**
* 功能:按内部遥信类型选择完整SIQ/DIQ允许位。
* 输入参数:type为报文体的类型字段
* 输出参数:无
* 返回值:单点0xF1、双点0xF3,未定义类型为0。
* 说明:状态位和品质位均保留;0只表示类型非法,不是某个遥信状态。 只接收1/3/30/31,其他编号一律拒绝,不能默认作为双点处理。
*/
static uint8_t Fault_Event_Signal_Mask(uint8_t type)
{
if (type == IEC60870_ASDU_M_SP_NA_1 || type == IEC60870_ASDU_M_SP_TB_1) { return 0xF1U; }
if (type == IEC60870_ASDU_M_DP_NA_1 || type == IEC60870_ASDU_M_DP_TB_1) { return 0xF3U; }
return 0U;
}
/**
* 功能:取得单个遥测值的线上字节数,不含IOA。
* 输入参数:内部遥测类型
* 输出参数:无
* 返回值:13为4,9/11为2,其他为0表示不支持。
* 说明:两种分支都没有QDS;即使该组数量为0,也必须显式使用支持的类型。
*/
static unsigned int Fault_Event_Value_Size(uint8_t type)
{
if (type == IEC60870_ASDU_M_ME_NC_1) { return 4U; }
if (type == IEC60870_ASDU_M_ME_NA_1 || type == IEC60870_ASDU_M_ME_NB_1) { return 2U; }
return 0U;
}
/**
* 功能:验证本扩展允许的公共头语义及CA宽度。
* 输入参数:已验证的parameters,允许NULL的header
* 输出参数:无
* 返回值:1合法,0非法。
* 说明:前提:parameters有效;OA成员自身为uint8_t,COT为1字节时不编码OA。 CA为0或广播值的业务限制交由发布层处理,此处不查站注册。
*/
static int Fault_Event_Header_Valid(const IEC60870_AppLayerParameters_t *parameters,
const IEC60870_AsduHeader_t *header)
{
return header != NULL && header->cause_of_transmission == IEC60870_ASDU_COT_SPONTANEOUS &&
header->is_negative_confirm == 0U && header->is_test <= 1U &&
(parameters->sizeOfCA == 2 || header->common_address <= UINT8_MAX);
}
/**
* 功能:验证冻结记录的数量、类型、地址、状态、日历时标和有限浮点值。
* 输入参数:已验证的parameters,允许NULL的event
* 输出参数:无
* 返回值:1完整合法,0任一字段非法。
* 说明:前提:非空数组至少含其声明数量,调用期间输入有效且不变;先限制数量再访问数组。 N/M为0时不解引用对应数组,但不跳过类型校验;IOA仅查宽度,允许公共层的零地址。
* 仅用7字节时间暂存验证日期,不分配整帧临时数组,不把超过容量误归为内容错误。 编码写出阶段依赖这次全量校验,因此输入不可变要求必须贯穿整个Encode调用。
*/
static int Fault_Event_Input_Valid(const IEC60870_AppLayerParameters_t *parameters,
const IEC60870_FaultEvent_t *event)
{
uint32_t max_ioa = IEC60870_Object_Max_IOA(parameters);
uint8_t time_bytes[IEC60870_CP56_LEN];
uint8_t signal_mask;
size_t i;
if (event == NULL || event->signal_count > UINT8_MAX || event->measurement_count > UINT8_MAX ||
(event->signal_count != 0U && event->signals == NULL) ||
(event->measurement_count != 0U && event->measurements == NULL)) { return 0; }
signal_mask = Fault_Event_Signal_Mask(event->signal_type);
if (signal_mask == 0U || Fault_Event_Value_Size(event->measurement_type) == 0U) { return 0; }
for (i = 0U; i < event->signal_count; ++i) {
const IEC60870_FaultEventSignal_t *signal = &event->signals[i];
if (signal->ioa > max_ioa || (signal->value & (uint8_t)~signal_mask) != 0U ||
!IEC60870_Time_To_CP56(&signal->timestamp, time_bytes, sizeof(time_bytes))) { return 0; }
}
for (i = 0U; i < event->measurement_count; ++i) {
const IEC60870_FaultEventMeasurement_t *measurement = &event->measurements[i];
if (measurement->ioa > max_ioa ||
(event->measurement_type == IEC60870_ASDU_M_ME_NC_1 &&
!isfinite(measurement->value.short_float))) { return 0; }
}
return 1;
}
/**
* 功能:重置描述并选择默认内部类型30/13。 输入/
* 输入参数:无。
* 输出参数:调用方可写event,NULL无操作
* 返回值:无。
* 说明:只清描述,不操作原数组;默认13支持负电气量,避免负整数原码被按无符号数解释。
*/
void IEC60870_FaultEvent_Init(IEC60870_FaultEvent_t *event)
{
if (event == NULL) { return; }
memset(event, 0, sizeof(*event));
event->signal_type = IEC60870_ASDU_M_SP_TB_1;
event->measurement_type = IEC60870_ASDU_M_ME_NC_1;
}
/**
* 功能:把完整冻结快照编码为一条Type42 ASDU。
* 输入参数:parameters/header/event及out容量,具体字段范围见公开头文件。
* 输出参数:仅成功时写out原文和out_length总长
* 返回值:OK、字段ERROR或容量FULL。
* 说明:前提:输入在调用内有效且不变,输入/输出及两个输出之间不重叠;调用方串行使用这些存储。 字段校验先于容量校验,确保坏记录即使同时装不下也返回ERROR;不隐式拆分或部分成功。
*/
IEC60870_AsduResult_t IEC60870_FaultEvent_Encode(
const IEC60870_AppLayerParameters_t *parameters,
const IEC60870_AsduHeader_t *header, const IEC60870_FaultEvent_t *event,
uint8_t *out, uint16_t capacity, uint16_t *out_length)
{
size_t required, i;
unsigned int header_size, address_size, value_size;
uint8_t *cursor;
if (out == NULL || out_length == NULL || !IEC60870_AppLayerParameters_Valid(parameters) ||
!Fault_Event_Header_Valid(parameters, header) || !Fault_Event_Input_Valid(parameters, event)) {
return IEC60870_ASDU_ERROR;
}
header_size = Fault_Event_Header_Size(parameters);
address_size = (unsigned int)parameters->sizeOfIOA;
value_size = Fault_Event_Value_Size(event->measurement_type);
/* 设L为统一IOA宽度、V为遥测值宽度:每条遥信为L+1(SIQ/DIQ)+7(CP56)=L+8,
* 每条遥测为L+V;额外4字节是N、遥信类型、M、遥测类型,不是4个计数。
* 数量先限制到255后计算,最大和小于8192,避免按截窄后的数量接受过长快照。 */
required = header_size + 4U + event->signal_count * (address_size + 8U) +
event->measurement_count * (address_size + value_size);
if (required > capacity || required > (size_t)parameters->maxSizeOfASDU) { return IEC60870_ASDU_FULL; }
/* 此后所有内容已验证;只有成功路径写调用方缓冲,失败不会残留半条事件。
* VSQ只是固定占位,不能随内部记录数量累加;公共头后立即是N,没有外层IOA。 */
out[0] = IEC60870_ASDU_M_FT_NA_1;
out[1] = 1U;
out[2] = (uint8_t)(header->cause_of_transmission | (header->is_test ? 0x80U : 0U));
if (parameters->sizeOfCOT == 2) { out[3] = header->originator_address; }
IEC60870_Object_Write_LE(out + 2U + (unsigned int)parameters->sizeOfCOT,
header->common_address, (unsigned int)parameters->sizeOfCA);
cursor = out + header_size;
*cursor++ = (uint8_t)event->signal_count;
*cursor++ = event->signal_type;
for (i = 0U; i < event->signal_count; ++i) {
const IEC60870_FaultEventSignal_t *signal = &event->signals[i];
IEC60870_Object_Write_LE(cursor, signal->ioa, address_size);
cursor += address_size;
*cursor++ = signal->value;
/* 同一日历已经用等长暂存验证;输入不可变且与out不重叠时,此调用必然成功。
* 因而忽略返回值并非容忍坏时间,也不能据此允许编码中途修改采集数组。
* CP56输出保留日历及IV/SU,星期/GEN按时间库规则规范化,不承诺原七字节回显。 */
(void)IEC60870_Time_To_CP56(&signal->timestamp, cursor, IEC60870_CP56_LEN);
cursor += IEC60870_CP56_LEN;
}
*cursor++ = (uint8_t)event->measurement_count;
*cursor++ = event->measurement_type;
for (i = 0U; i < event->measurement_count; ++i) {
const IEC60870_FaultEventMeasurement_t *measurement = &event->measurements[i];
uint32_t raw;
IEC60870_Object_Write_LE(cursor, measurement->ioa, address_size);
cursor += address_size;
/* memcpy取得binary32位模式,避免float*到整数指针的别名/对齐问题;
* 再按整数逐字节写LE,不把宿主内存字节序直接复制到线上。2字节分支仅传无符号原码。 */
if (value_size == 4U) { memcpy(&raw, &measurement->value.short_float, sizeof(raw)); }
else { raw = measurement->value.unsigned_value; }
IEC60870_Object_Write_LE(cursor, raw, value_size);
cursor += value_size;
}
*out_length = (uint16_t)required;
return IEC60870_ASDU_OK;
}
/**
* 功能:验证并读取一条遥信记录,不处理外层公共头。
* 输入参数:record至少含L+8字节,address_size为1..3,signal_type已确认为支持类型。
* 输出参数:signal非NULL时仅在成功后赋值;NULL用于整帧预检
* 返回值:1合法,0状态/CP56非法。
* 说明:前提:调用方已经验证完整记录边界,输出不与输入重叠;本函数不再次检查长度或类型。 局部结果先初始化后发布,保留完整SIQ/DIQ,不按接收端界面文字重映射状态。
*/
static int Fault_Event_Read_Signal(const uint8_t *record, unsigned int address_size,
uint8_t signal_type, IEC60870_FaultEventSignal_t *signal)
{
IEC60870_FaultEventSignal_t result;
uint8_t mask = Fault_Event_Signal_Mask(signal_type);
memset(&result, 0, sizeof(result));
result.ioa = IEC60870_Object_Read_LE(record, address_size);
result.value = record[address_size];
if ((result.value & (uint8_t)~mask) != 0U ||
!IEC60870_Time_From_CP56(record + address_size + 1U, IEC60870_CP56_LEN,
&result.timestamp)) { return 0; }
if (signal != NULL) { *signal = result; }
return 1;
}
/**
* 功能:验证并读取一条遥测记录;不添加品质或时标。
* 输入参数:record至少含L+V字节,address_size为1..3,value_size已确认为2或4。
* 输出参数:measurement非NULL时仅在成功后赋值;NULL仅预检
* 返回值:1合法,0浮点非有限。
* 说明:前提:调用方已验证边界和类型,输出不与输入重叠。 先按LE读成整数位模式,再memcpy为float,避免指针别名及未对齐读;2字节保持uint16_t原码。
*/
static int Fault_Event_Read_Measurement(const uint8_t *record, unsigned int address_size,
unsigned int value_size, IEC60870_FaultEventMeasurement_t *measurement)
{
IEC60870_FaultEventMeasurement_t result;
uint32_t raw = IEC60870_Object_Read_LE(record + address_size, value_size);
memset(&result, 0, sizeof(result));
result.ioa = IEC60870_Object_Read_LE(record, address_size);
if (value_size == 4U) {
memcpy(&result.value.short_float, &raw, sizeof(raw));
if (!isfinite(result.value.short_float)) { return 0; }
} else { result.value.unsigned_value = (uint16_t)raw; }
if (measurement != NULL) { *measurement = result; }
return 1;
}
/**
* 功能:验证两组异构记录的完整ASDU并建立借用视图。
* 输入参数:parameters及asdu/length
* 输出参数:仅完整成功后写view
* 返回值:OK或ERROR。
* 说明:前提:输入存储在解析和取值期间有效且不变,view与输入不重叠。 公共头解析不负责Type42对象长度,必须继续验证内部两组计数、精确总长和每条载荷。 N/M为0不免除两组类型字段;
* VSQ完全不参与记录数和步长推导。
*/
IEC60870_AsduResult_t IEC60870_FaultEvent_Parse(
const IEC60870_AppLayerParameters_t *parameters,
const uint8_t *asdu, uint16_t length, IEC60870_FaultEventView_t *view)
{
IEC60870_AsduInfo_t header;
IEC60870_FaultEventView_t result;
size_t signal_size, measurement_offset, expected, i;
unsigned int address_size, value_size;
const uint8_t *body;
if (view == NULL || !IEC60870_Parse_ASDU_Header(parameters, asdu, length, &header) ||
header.type_id != IEC60870_ASDU_M_FT_NA_1 ||
header.cause_of_transmission != IEC60870_ASDU_COT_SPONTANEOUS || header.is_negative_confirm ||
header.information_objects_len < 4U) { return IEC60870_ASDU_ERROR; }
body = header.information_objects;
address_size = (unsigned int)parameters->sizeOfIOA;
signal_size = address_size + 8U;
/* body前2字节是N和遥信类型,随后N*(L+8)字节才到M;
* 先确认M及遥测类型这2字节都存在,再读取第二组,不能先读后补边界检查。
* VSQ的低7位和SQ均不参与此计算。 */
measurement_offset = 2U + (size_t)body[0] * signal_size;
if (Fault_Event_Signal_Mask(body[1]) == 0U || measurement_offset + 2U > header.information_objects_len) {
return IEC60870_ASDU_ERROR;
}
value_size = Fault_Event_Value_Size(body[measurement_offset + 1U]);
/* 精确相等同时拒绝截短和尾随数据,包括误加的遥测QDS;
* 不允许只解析可用前缀后把余下记录留给上层猜测。 */
expected = measurement_offset + 2U + (size_t)body[measurement_offset] * (address_size + value_size);
if (value_size == 0U || expected != header.information_objects_len) { return IEC60870_ASDU_ERROR; }
for (i = 0U; i < body[0]; ++i) {
if (!Fault_Event_Read_Signal(body + 2U + i * signal_size, address_size, body[1], NULL)) {
return IEC60870_ASDU_ERROR;
}
}
for (i = 0U; i < body[measurement_offset]; ++i) {
if (!Fault_Event_Read_Measurement(body + measurement_offset + 2U + i * (address_size + value_size),
address_size, value_size, NULL)) { return IEC60870_ASDU_ERROR; }
}
/* 两组所有记录均已通过检查,此时才形成可对外发布的视图;
* 只复制头字段和位置元数据,不复制参数或原文,不延长它们的存储寿命。 */
memset(&result, 0, sizeof(result));
result.header.cause_of_transmission = header.cause_of_transmission;
result.header.is_negative_confirm = header.is_negative_confirm;
result.header.is_test = header.is_test;
result.header.originator_address = header.originator_address;
result.header.common_address = header.common_address;
result.parameters = parameters;
result.asdu = asdu;
result.length = length;
result.signal_count = body[0];
result.signal_type = body[1];
result.measurement_count = body[measurement_offset];
result.measurement_type = body[measurement_offset + 1U];
*view = result;
return IEC60870_ASDU_OK;
}
/**
* 功能:从有效借用视图中按值读取第index条遥信。
* 输入参数:view及从0开始的index
* 输出参数:仅成功后写signal
* 返回值:OK或ERROR。
* 说明:前提:view由Parse建立,参数及原文有效且不变,输出与它们不重叠。 重新检查整帧后才按计数定位,避免别组损坏时仍返回一条看似有效的记录。 重检不是并发保护,也不能检查原文是否已释放;
* 调用方仍负责寿命和串行访问。
*/
IEC60870_AsduResult_t IEC60870_FaultEvent_Get_Signal(
const IEC60870_FaultEventView_t *view, size_t index,
IEC60870_FaultEventSignal_t *signal)
{
IEC60870_FaultEventView_t checked;
unsigned int address_size;
const uint8_t *record;
if (view == NULL || signal == NULL ||
IEC60870_FaultEvent_Parse(view->parameters, view->asdu, view->length, &checked) != IEC60870_ASDU_OK ||
index >= checked.signal_count) { return IEC60870_ASDU_ERROR; }
address_size = (unsigned int)checked.parameters->sizeOfIOA;
record = checked.asdu + Fault_Event_Header_Size(checked.parameters) + 2U + index * (address_size + 8U);
return Fault_Event_Read_Signal(record, address_size, checked.signal_type, signal) ?
IEC60870_ASDU_OK : IEC60870_ASDU_ERROR;
}
/**
* 功能:从有效借用视图中按值读取第index条遥测。
* 输入参数:view及从0开始的index
* 输出参数:仅成功后写measurement
* 返回值:OK或ERROR。
* 说明:前提:与Get_Signal相同,重检原文不撤销不可变/存储寿命要求。 从公共头后跳过4个数量/类型字节与整组遥信,再按L+V定位; 只产生值和地址,不把读取时刻当成故障时间。
*/
IEC60870_AsduResult_t IEC60870_FaultEvent_Get_Measurement(
const IEC60870_FaultEventView_t *view, size_t index,
IEC60870_FaultEventMeasurement_t *measurement)
{
IEC60870_FaultEventView_t checked;
unsigned int address_size, value_size;
const uint8_t *record;
if (view == NULL || measurement == NULL ||
IEC60870_FaultEvent_Parse(view->parameters, view->asdu, view->length, &checked) != IEC60870_ASDU_OK ||
index >= checked.measurement_count) { return IEC60870_ASDU_ERROR; }
address_size = (unsigned int)checked.parameters->sizeOfIOA;
value_size = Fault_Event_Value_Size(checked.measurement_type);
record = checked.asdu + Fault_Event_Header_Size(checked.parameters) + 4U +
(size_t)checked.signal_count * (address_size + 8U) + index * (address_size + value_size);
return Fault_Event_Read_Measurement(record, address_size, value_size, measurement) ?
IEC60870_ASDU_OK : IEC60870_ASDU_ERROR;
}