349 lines
18 KiB
C
349 lines
18 KiB
C
/*
|
||
* 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;
|
||
}
|