/* * Type42故障事件信息完整ASDU:两组异构记录共用链路IOA宽度,计数位于报文体。 * 此处采用故障事件扩展布局,不属于基础IEC标准定义的Type42对象。 * 两组记录分别携带数量和类型,不能在首记录前补普通外层IOA或在遥测值后补QDS。 * 编码先验证全部输入和容量,再写入;解析先验证整帧,再发布借用视图。 * 本模块只负责冻结简报的字节契约;故障判据、连续录波与上送先后分别由调用方组织, * 不能用本模块的编码成功推断故障已经送达,或推断相应录波文件已经可靠保存。 */ #include "IEC60870_FaultEvent.h" #include "IEC60870_InformationObjects_Internal.h" #include #include #include /* 后续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; }