feat(iec104): 把 104 骨架完整迁到 MCU 板端并在台架跑通总召
把 IEC104 从模拟器端整体搬到板端:协议栈原先由独立 iec104Task 驱动, 现在改为 netTask 单 owner 的 threadless 驱动,退役独立任务。 驱动与后端: - 新增 iec104_net_mcu.c/.h,实现 IEC104_Net.h 的 11 个 ABI 函数, 用槽表加单调句柄映射 net_socket 的单 fd 模型;CLIENT 拆除只走 net_drop_conn_locked,绝不 net_close 监听 fd。 - net_socket 增 5 个 owner-only 接口(net_accept_locked、 net_drop_conn_locked、net_pending_bytes、net_send_try、 net_mono_now_ms)。 - iec104_serv.c 重写为 iec104_serv_net_tick(),在 netTask 1ms 主循环 里驱动 core;无 osDelay/阻塞调用,喂狗是第一句。 - Src/freertos.c 删除 iec104Task 三件套,对应栈水位探针表项同步删除。 内存:目标板 192KB SRAM 装不下 vendor 默认容量档,按实测裁剪到 skeleton 档(TCP 缓冲、业务池、SOE 256->128、值槽密集化), RW_IRAM1 118,408 B / 90.3%,留 2,178 B 余量。 台架修复(只在真硬件暴露): - SNTP s_ctx.fd 零初始化后为 0,而 net fd 0 是合法槽位下标, 首次代次变化时误 net_close(0) 关掉 ftpTask 的监听槽,导致 104 连接被 FTP 的 220 banner 抢走;改为显式 .fd = -1。 - Accept 幂等:单 fd 模型下 vendor 每轮重试 Accept 会拿到同一 fd, 后端改为会话在役时返 WOULD_BLOCK,Close 不再清槽。 验证: - Keil 全量重建 0 error 0 warning,uvprojx 零抖动。 - 模拟器真实 TCP 13/13、transport 10/10。 - netmcu 后端单测 13/13(新增 N12)。 - 台架 serial-boot-test required 全中;板端 2404 总召 129 帧收到 59 遥信(53 有源、全 IV)+ 16 双点 + 30 遥测(PT1 三相非零、 UN/频率/温度按未标定置 IV)、遥控选择执行全否定、校时 COT 7。 - 期间顺带修正 UI 漂移自检文案、.serialtest required 陈旧项、 coding-standard 对 vendor 与外部 ABI 名字的排除口径。
This commit is contained in:
@@ -1,208 +0,0 @@
|
||||
/*
|
||||
* 模块名称:IEC 60870-5-104 ASDU 编解码(应用层,纯逻辑)
|
||||
* 模块功能:实现 iec104_asdu.h——ASDU 头解析/组装、IOA 3B 小端、IEEE754
|
||||
* 短浮点小端、CP56Time2a ↔ epoch 毫秒(UTC 分解,Hinnant civil
|
||||
* 日历算法,不依赖 time.h → ARMCC/MSVC 双端可移植)。
|
||||
* 线程约定:全部纯函数,无状态 → 任意上下文可调。
|
||||
* 创建日期:2026-10-12(B4)
|
||||
*/
|
||||
#include "iec104_asdu.h"
|
||||
|
||||
#include <string.h>
|
||||
|
||||
/* COT 首字节:bit0..5 = 值,bit6 = PN,bit7 = T;RBT 复用 bit4(C_IC 语义) */
|
||||
#define COT_VAL_MASK 0x3FU
|
||||
#define COT_FLAG_MASK 0xC0U
|
||||
|
||||
/*
|
||||
* 函数功能:解析 ASDU 头(6B),信息体起点经 obj/obj_len 指出
|
||||
* 入口参数:buf/len = ASDU 首字节与总长;hdr = 输出
|
||||
* 返 回 值:0 成功 / -1 空指针或长度不足 6B
|
||||
*/
|
||||
int iec104_asdu_parse_hdr(const uint8_t *buf, uint16_t len, iec104_asdu_hdr_t *hdr) {
|
||||
if ((buf == NULL) || (hdr == NULL) || (len < 6u)) {
|
||||
return -1;
|
||||
}
|
||||
hdr->type = buf[0];
|
||||
hdr->vsq = buf[1];
|
||||
hdr->cot = (uint8_t)(buf[2] & COT_VAL_MASK);
|
||||
hdr->cot_hi = (uint8_t)(buf[2] & 0xC0u);
|
||||
hdr->oa = buf[3];
|
||||
hdr->ca = (uint16_t)(buf[4] | ((uint16_t)buf[5] << 8));
|
||||
hdr->obj = &buf[6];
|
||||
hdr->obj_len = (uint16_t)(len - 6u);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:组装 ASDU 头(OA 恒 0,EVI 由调用方置 buf[3];RBT 位透传)
|
||||
* 入口参数:cot = 6bit 原因值;cot_hi = 标志位(T/PN/RBT);ca = 公共地址
|
||||
* 返 回 值:固定 6(头字节数)
|
||||
*/
|
||||
uint16_t iec104_asdu_put_hdr(uint8_t *buf, uint8_t type, uint8_t vsq,
|
||||
uint8_t cot, uint8_t cot_hi, uint16_t ca) {
|
||||
buf[0] = type;
|
||||
buf[1] = vsq;
|
||||
buf[2] = (uint8_t)(((uint8_t)(cot & COT_VAL_MASK))
|
||||
| (uint8_t)(cot_hi & COT_FLAG_MASK)
|
||||
| (uint8_t)(cot_hi & 0x10u)); /* RBT 位透传 */
|
||||
buf[3] = 0u; /* OA = 0(EVI 由调用方按需置位) */
|
||||
buf[4] = (uint8_t)(ca & 0xFFu);
|
||||
buf[5] = (uint8_t)(ca >> 8);
|
||||
return 6u;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:IOA 3 字节小端写入
|
||||
*/
|
||||
void iec104_put_ioa(uint8_t *buf, uint32_t ioa) {
|
||||
buf[0] = (uint8_t)(ioa & 0xFFu);
|
||||
buf[1] = (uint8_t)((ioa >> 8) & 0xFFu);
|
||||
buf[2] = (uint8_t)((ioa >> 16) & 0xFFu);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:IOA 3 字节小端读取
|
||||
*/
|
||||
uint32_t iec104_get_ioa(const uint8_t *buf) {
|
||||
return (uint32_t)buf[0] | ((uint32_t)buf[1] << 8) | ((uint32_t)buf[2] << 16);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:IEEE754 短浮点 → 小端字节序(104 恒小端,宿主字节序无关)
|
||||
*/
|
||||
void iec104_put_float(uint8_t *buf, float v) {
|
||||
/* 位模式小端:memcpy 不假设宿主字节序,逐字节拆给目标(104 恒小端) */
|
||||
uint8_t tmp[sizeof(float)];
|
||||
uint32_t i;
|
||||
|
||||
(void)memcpy(tmp, &v, sizeof(tmp));
|
||||
for (i = 0u; i < sizeof(tmp); i++) {
|
||||
#if defined(__BYTE_ORDER__) && (__BYTE_ORDER__ == __ORDER_BIG_ENDIAN__)
|
||||
buf[i] = tmp[sizeof(tmp) - 1u - i];
|
||||
#else
|
||||
buf[i] = tmp[i];
|
||||
#endif
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:小端字节序 → IEEE754 短浮点
|
||||
*/
|
||||
float iec104_get_float(const uint8_t *buf) {
|
||||
uint8_t tmp[sizeof(float)];
|
||||
uint32_t i;
|
||||
float v;
|
||||
|
||||
for (i = 0u; i < sizeof(tmp); i++) {
|
||||
#if defined(__BYTE_ORDER__) && (__BYTE_ORDER__ == __ORDER_BIG_ENDIAN__)
|
||||
tmp[i] = buf[sizeof(tmp) - 1u - i];
|
||||
#else
|
||||
tmp[i] = buf[i];
|
||||
#endif
|
||||
}
|
||||
(void)memcpy(&v, tmp, sizeof(v));
|
||||
return v;
|
||||
}
|
||||
|
||||
/* ---------------- CP56Time2a ↔ epoch ---------------- */
|
||||
|
||||
/* 2000-01-01 00:00:00 UTC 的 epoch 毫秒(钳位下限) */
|
||||
#define EPOCH_2000_MS 946684800000ULL
|
||||
|
||||
/*
|
||||
* 函数功能:公历(y>=1)→ 距 1970-01-01 天数(Hinnant civil_from_days 正向)
|
||||
* 说明:纯整数算法;m 取 1..12。
|
||||
*/
|
||||
static uint32_t s_days_from_civil(uint32_t y, uint32_t m, uint32_t d) {
|
||||
uint32_t yy = y - ((m <= 2u) ? 1u : 0u);
|
||||
uint32_t era = yy / 400u;
|
||||
uint32_t yoe = yy - (era * 400u);
|
||||
uint32_t mp = (m > 2u) ? (m - 3u) : (m + 9u); /* 3 月 = 月序 0 */
|
||||
uint32_t doy = ((153u * mp) + 2u) / 5u + d - 1u;
|
||||
uint32_t doe = (yoe * 365u) + (yoe / 4u) - (yoe / 100u) + doy;
|
||||
|
||||
return (era * 146097u) + doe - 719468u;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:距 1970-01-01 天数 → 公历(Hinnant 反向)
|
||||
* 入口参数:z_in = 天数;y/m/d = 输出
|
||||
*/
|
||||
static void s_civil_from_days(uint32_t z_in, uint32_t *y, uint32_t *m, uint32_t *d) {
|
||||
uint32_t z = z_in + 719468u;
|
||||
uint32_t era = z / 146097u;
|
||||
uint32_t doe = z - (era * 146097u);
|
||||
uint32_t yoe = (doe - (doe / 1460u) + (doe / 36524u) - (doe / 146096u)) / 365u;
|
||||
uint32_t yy = yoe + (era * 400u);
|
||||
uint32_t doy = doe - ((365u * yoe) + (yoe / 4u) - (yoe / 100u));
|
||||
uint32_t mp = ((5u * doy) + 2u) / 153u;
|
||||
uint32_t mon = mp + ((mp < 10u) ? 3u : 0u);
|
||||
|
||||
*d = doy - (((153u * mp) + 2u) / 5u) + 1u;
|
||||
if (mp >= 10u) {
|
||||
mon = mp - 9u;
|
||||
}
|
||||
*m = mon;
|
||||
*y = yy + ((mon <= 2u) ? 1u : 0u);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:CP56Time2a → epoch 毫秒(UTC 分解)
|
||||
* 入口参数:buf = 7B;epoch_ms = 输出
|
||||
* 返 回 值:0 成功 / -2 IV(时间无效,调用方应拒绝)/ -1 字段越界
|
||||
*/
|
||||
int iec104_cp56_to_epoch_ms(const uint8_t *buf, uint64_t *epoch_ms) {
|
||||
uint32_t ms_min, minute, hour, day, mon, year;
|
||||
|
||||
if ((buf == NULL) || (epoch_ms == NULL)) {
|
||||
return -1;
|
||||
}
|
||||
if ((buf[2] & 0x80u) != 0u) {
|
||||
return -2; /* IV:时间无效,调用方应拒绝 */
|
||||
}
|
||||
ms_min = (uint32_t)buf[0] | ((uint32_t)buf[1] << 8); /* 0..59999 */
|
||||
minute = (uint32_t)buf[2] & 0x3Fu;
|
||||
hour = (uint32_t)buf[3] & 0x1Fu;
|
||||
day = (uint32_t)buf[4] & 0x1Fu;
|
||||
mon = (uint32_t)buf[5] & 0x0Fu;
|
||||
year = 2000u + ((uint32_t)buf[6] & 0x7Fu);
|
||||
if ((day == 0u) || (day > 31u) || (mon == 0u) || (mon > 12u)
|
||||
|| (hour > 23u) || (minute > 59u) || (ms_min > 59999u)) {
|
||||
return -1;
|
||||
}
|
||||
*epoch_ms = ((uint64_t)s_days_from_civil(year, mon, day) * 86400000ULL)
|
||||
+ ((uint64_t)hour * 3600000ULL)
|
||||
+ ((uint64_t)minute * 60000ULL)
|
||||
+ (uint64_t)ms_min;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:epoch 毫秒 → CP56Time2a(钳位 [2000-01-01, 2127-12-31],IV 恒 0)
|
||||
* 返 回 值:固定 7(字节数)
|
||||
*/
|
||||
uint16_t iec104_epoch_ms_to_cp56(uint64_t epoch_ms, uint8_t *buf) {
|
||||
uint64_t days, rem, clamped;
|
||||
uint32_t y, m, d, ms_min;
|
||||
|
||||
clamped = (epoch_ms < EPOCH_2000_MS) ? EPOCH_2000_MS : epoch_ms;
|
||||
days = clamped / 86400000ULL;
|
||||
rem = clamped % 86400000ULL;
|
||||
s_civil_from_days((uint32_t)days, &y, &m, &d);
|
||||
if (y > 2127u) { /* 年字段 7bit 上限(2000+127) */
|
||||
y = 2127u;
|
||||
m = 12u;
|
||||
d = 31u;
|
||||
rem = 86399999ULL;
|
||||
}
|
||||
ms_min = (uint32_t)(rem % 60000ULL);
|
||||
buf[0] = (uint8_t)(ms_min & 0xFFu);
|
||||
buf[1] = (uint8_t)(ms_min >> 8);
|
||||
buf[2] = (uint8_t)((rem / 60000ULL) % 60ULL); /* min,IV=0 */
|
||||
buf[3] = (uint8_t)((rem / 3600000ULL) % 24ULL); /* hour */
|
||||
buf[4] = (uint8_t)(d & 0x1Fu); /* day */
|
||||
buf[5] = (uint8_t)(m & 0x0Fu); /* month */
|
||||
buf[6] = (uint8_t)((y - 2000u) & 0x7Fu); /* year */
|
||||
return 7u;
|
||||
}
|
||||
@@ -225,6 +225,19 @@ static bool drain_events(unsigned budget)
|
||||
if (next != IEC104_TCP_EVENT_READY) { return false; }
|
||||
if (transport->type == IEC104_TCP_EVENT_CONNECTED) { increment(&s_core.status.connections); }
|
||||
if (transport->type == IEC104_TCP_EVENT_I_FRAME) { increment(&s_core.status.received_i_frames); }
|
||||
if (transport->type == IEC104_TCP_EVENT_DISCONNECTED) {
|
||||
/* task-18:帧级发送类故障会话计数。DISCONNECTED 每会话一次,
|
||||
* 本处只多调一次状态查询,原有幂等/控制流不变。计的是以发送类
|
||||
* 故障结束的会话次数;不是发送字节失败数、不是短写次数、
|
||||
* 不是库内部放弃帧的次数。 */
|
||||
IEC104_TcpServerStatus_t snap;
|
||||
if (IEC104_Slave_Get_Status(s_core.slave, &snap, &s_core.error) == IEC104_TCP_OK &&
|
||||
snap.connection_status_valid != 0U &&
|
||||
(snap.connection.fault == IEC104_TCP_FAULT_LOCAL_SEND_TIMEOUT ||
|
||||
snap.connection.fault == IEC104_TCP_FAULT_TRANSPORT)) {
|
||||
increment(&s_core.status.frame_failures);
|
||||
}
|
||||
}
|
||||
if (transport->type == IEC104_TCP_EVENT_RECORD) {
|
||||
if (transport->data.record.value.local_send_completed != 0U) {
|
||||
increment(&s_core.status.written_i_frames);
|
||||
|
||||
@@ -30,6 +30,11 @@ typedef struct {
|
||||
int last_error;
|
||||
int last_stage;
|
||||
int native_error;
|
||||
/* Counts sessions that ended with a send-class fault: on DISCONNECTED, when
|
||||
* connection_status_valid and fault is LOCAL_SEND_TIMEOUT or TRANSPORT.
|
||||
* It is NOT a count of failed bytes, short writes, or library-internal
|
||||
* abandoned frames. Reset at each admitted start. */
|
||||
uint32_t frame_failures;
|
||||
} iec104_core_status_t;
|
||||
|
||||
/* All calls must be serialized on the same owner thread. 0=OK, -1=error.
|
||||
|
||||
@@ -1,797 +0,0 @@
|
||||
/*
|
||||
* 模块名称:IEC 60870-5-104 链路层(实现)
|
||||
* 模块功能:实现 iec104_link.h——APCI 流重组与 U/S/I 编解码、STARTDT/STOPDT/
|
||||
* TESTFR、k/w 窗与 t1/t2/t3(差值法,tick 回绕安全)、总召分片、
|
||||
* COV 突发(k 窗满暂存不丢)、周期上送、遥控/定值两段式、C_RD、
|
||||
* C_CS 对时、错误应答(COT 12/13/14 + EVI)。
|
||||
* 失败语义:坏帧/序号错/N(R) 越窗/缓冲溢出 → 实例置 IDLE(链路故障),
|
||||
* 由胶水层检测 IDLE 跳变断开 socket;本层不感知 I/O。
|
||||
* 创建日期:2026-10-12(B4)
|
||||
*/
|
||||
#include "iec104_link.h"
|
||||
|
||||
#include "iec104_asdu.h"
|
||||
|
||||
#include <string.h>
|
||||
|
||||
/* ---------------- APCI 常量 ---------------- */
|
||||
#define APCI_START 0x68u
|
||||
#define APCI_CTRL_LEN 4u /* len 字段最小值(纯控制域) */
|
||||
#define APCI_LEN_MIN 4u
|
||||
#define APCI_LEN_MAX 252u
|
||||
#define SEQ_MOD 32768u /* 序号 15bit */
|
||||
|
||||
/* U 帧控制字节(DL/T 634.5104 表:低 2 位恒 11) */
|
||||
#define U_STARTDT_ACT 0x07u
|
||||
#define U_STARTDT_CON 0x0Bu
|
||||
#define U_STOPDT_ACT 0x13u
|
||||
#define U_STOPDT_CON 0x23u
|
||||
#define U_TESTFR_ACT 0x43u
|
||||
#define U_TESTFR_CON 0x83u
|
||||
|
||||
/* 本实现单 ASDU 信息体区上限(背景 YC 组 8×5=40 B 最大) */
|
||||
#define BODY_MAX 64u
|
||||
/* 周期上送周期(COT=1) */
|
||||
#define PERIOD_MS 60000UL
|
||||
|
||||
/*
|
||||
* 函数功能:超时判定(now 到达/越过 deadline,tick 回绕安全)
|
||||
* 返 回 值:1 已到期 / 0 未到期
|
||||
*/
|
||||
static int s_expired(uint32_t now, uint32_t deadline) {
|
||||
return (((int32_t)(now - deadline)) >= 0) ? 1 : 0;
|
||||
}
|
||||
|
||||
/* ---------------- 发送原语 ---------------- */
|
||||
|
||||
/*
|
||||
* 函数功能:发 U 帧(STARTDT/STOPDT/TESTFR act|con)
|
||||
* 说明:t1 只约束"需确认的发送"(标准语义)——TESTFR act 置挂起并起 t1;
|
||||
* STARTDT/STOPDT con 不启动 t1(主站可合法静默,靠 t3 探活)。
|
||||
*/
|
||||
static void s_send_u(iec104_link_t *lk, uint8_t q) {
|
||||
uint8_t buf[6];
|
||||
|
||||
if (lk->cfg->send_apdu == NULL) {
|
||||
return;
|
||||
}
|
||||
buf[0] = APCI_START;
|
||||
buf[1] = APCI_CTRL_LEN;
|
||||
buf[2] = q;
|
||||
buf[3] = 0u;
|
||||
buf[4] = 0u;
|
||||
buf[5] = 0u;
|
||||
lk->cfg->send_apdu(lk->ctx, buf, 6u);
|
||||
/* t1 只约束"需确认的发送"(标准语义):TESTFR act 等 con;
|
||||
* STARTDT/STOPDT con 不启动 t1——主站可合法静默,靠 t3 探活 */
|
||||
if (q == U_TESTFR_ACT) {
|
||||
lk->testfr_pending = 1u;
|
||||
lk->t1_deadline = lk->now_ms + IEC104_T1_MS;
|
||||
}
|
||||
lk->t3_deadline = lk->now_ms + IEC104_T3_MS;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:发 S 帧(确认已收序号,rx_unacked 清零)
|
||||
* 说明:S 不需对端确认 → 不起 t1,只刷 t3。
|
||||
*/
|
||||
static void s_send_s(iec104_link_t *lk) {
|
||||
uint8_t buf[6];
|
||||
uint16_t r = (uint16_t)(lk->rx_seq << 1);
|
||||
|
||||
if (lk->cfg->send_apdu == NULL) {
|
||||
return;
|
||||
}
|
||||
buf[0] = APCI_START;
|
||||
buf[1] = APCI_CTRL_LEN;
|
||||
buf[2] = 0x01u;
|
||||
buf[3] = 0u;
|
||||
buf[4] = (uint8_t)(r & 0xFFu);
|
||||
buf[5] = (uint8_t)(r >> 8);
|
||||
lk->cfg->send_apdu(lk->ctx, buf, 6u);
|
||||
lk->rx_unacked = 0u;
|
||||
lk->t3_deadline = lk->now_ms + IEC104_T3_MS; /* S 不需确认 → 不起 t1 */
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:发一个 I 帧(asdu 由调用方组好,N(S)/N(R) 由本层填)
|
||||
* 返 回 值:0 已发出 / -1 k 窗满或超长(调用方保留数据下次重试)
|
||||
*/
|
||||
static int s_send_i(iec104_link_t *lk, const uint8_t *asdu, uint16_t len) {
|
||||
uint8_t buf[6u + BODY_MAX];
|
||||
uint16_t s16;
|
||||
uint16_t r16;
|
||||
|
||||
if ((lk->cfg->send_apdu == NULL) || (len > BODY_MAX)) {
|
||||
return -1;
|
||||
}
|
||||
if (lk->tx_unacked >= IEC104_K_MAX) {
|
||||
return -1;
|
||||
}
|
||||
buf[0] = APCI_START;
|
||||
buf[1] = (uint8_t)(APCI_CTRL_LEN + len);
|
||||
s16 = (uint16_t)(lk->tx_seq << 1);
|
||||
r16 = (uint16_t)(lk->rx_seq << 1);
|
||||
buf[2] = (uint8_t)(s16 & 0xFFu);
|
||||
buf[3] = (uint8_t)(s16 >> 8);
|
||||
buf[4] = (uint8_t)(r16 & 0xFFu);
|
||||
buf[5] = (uint8_t)(r16 >> 8);
|
||||
(void)memcpy(&buf[6], asdu, len);
|
||||
lk->tx_seq = (uint16_t)((lk->tx_seq + 1u) % SEQ_MOD);
|
||||
lk->tx_unacked++;
|
||||
lk->cfg->send_apdu(lk->ctx, buf, (uint16_t)(6u + len));
|
||||
lk->t1_deadline = lk->now_ms + IEC104_T1_MS;
|
||||
lk->t3_deadline = lk->now_ms + IEC104_T3_MS;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:组 ASDU(hdr [+ ioa] + body)并发 I 帧
|
||||
* 说明:evi=1 → OA bit7(EVI,未知 IOA/类型/地址类应答)
|
||||
* 返 回 值:同 s_send_i
|
||||
*/
|
||||
static int s_send_asdu(iec104_link_t *lk, uint8_t type, uint8_t vsq,
|
||||
uint8_t cot, uint8_t cot_hi,
|
||||
uint8_t with_ioa, uint32_t ioa,
|
||||
const uint8_t *body, uint16_t body_len, uint8_t evi) {
|
||||
uint8_t buf[6u + BODY_MAX];
|
||||
uint16_t n;
|
||||
|
||||
n = iec104_asdu_put_hdr(buf, type, vsq, cot, cot_hi, lk->cfg->ca);
|
||||
if (evi != 0u) {
|
||||
buf[3] |= 0x80u; /* OA bit7 = EVI */
|
||||
}
|
||||
if (with_ioa != 0u) {
|
||||
iec104_put_ioa(&buf[n], ioa);
|
||||
n += 3u;
|
||||
}
|
||||
if (body_len > 0u) {
|
||||
if ((uint32_t)n + (uint32_t)body_len > (uint32_t)sizeof(buf)) {
|
||||
return -1;
|
||||
}
|
||||
(void)memcpy(&buf[n], body, body_len);
|
||||
n += body_len;
|
||||
}
|
||||
return s_send_i(lk, buf, n);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:命令应答(actcon/deactcon 等)——原样回显信息体(ioa+限定词)
|
||||
* 入口参数:pn = 1 置否定确认位
|
||||
*/
|
||||
static void s_cmd_con(iec104_link_t *lk, uint8_t type, const uint8_t *obj,
|
||||
uint16_t obj_len, uint8_t cot, uint8_t pn) {
|
||||
uint8_t body[BODY_MAX];
|
||||
uint16_t n = obj_len;
|
||||
|
||||
if (n > BODY_MAX) {
|
||||
n = 0u;
|
||||
}
|
||||
if (n > 0u) {
|
||||
(void)memcpy(body, obj, n);
|
||||
}
|
||||
(void)s_send_asdu(lk, type, 1u, cot,
|
||||
(pn != 0u) ? IEC104_COT_BIT_PN : 0u,
|
||||
0u, 0u, body, n, 0u);
|
||||
}
|
||||
|
||||
/* ---------------- 数据上送 ---------------- */
|
||||
|
||||
/*
|
||||
* 函数功能:单点上送遥测(M_ME_NC_1 SQ=0,值+QDS)
|
||||
* 返 回 值:同 s_send_i
|
||||
*/
|
||||
static int s_send_yc_single(iec104_link_t *lk, uint8_t idx, uint8_t cot) {
|
||||
uint8_t body[5];
|
||||
float v;
|
||||
uint8_t qds;
|
||||
|
||||
(void)iec104_pts_yc_read(idx, &v, &qds);
|
||||
iec104_put_float(body, v);
|
||||
body[4] = qds;
|
||||
return s_send_asdu(lk, IEC104_T_M_ME_NC_1, 1u, cot, 0u, 1u,
|
||||
iec104_pts_yc_ioa(idx), body, 5u, 0u);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:总召/周期扫描一步(phase 游标 = interp_yx_idx:
|
||||
* 0 双点组→1 单点组→2 YC 组→3 频率→4 actterm)
|
||||
* 入口参数:budget = 本 poll 发送预算(成功一步减一);periodic = 周期扫描
|
||||
* 返 回 值:0 本步已发出 / -1 k 窗满原地保留(poll 循环必须就此停步,
|
||||
* 否则死循环——2026-10-12 单测抓到)
|
||||
*/
|
||||
static int s_scan_step(iec104_link_t *lk, uint8_t *budget, uint8_t periodic) {
|
||||
uint8_t body[BODY_MAX];
|
||||
uint8_t n = 0u;
|
||||
uint8_t i;
|
||||
uint8_t d;
|
||||
uint8_t qds;
|
||||
float v;
|
||||
int rc = -1;
|
||||
|
||||
switch (lk->interp_yx_idx) {
|
||||
case 0u: /* YX 双点组 SQ=1,IOA 1..4 */
|
||||
for (i = 0u; i < 4u; i++) {
|
||||
iec104_pts_yx_read(i, &d);
|
||||
body[n++] = d;
|
||||
}
|
||||
rc = s_send_asdu(lk, IEC104_T_M_DP_NA_1, (uint8_t)(IEC104_VSQ_SQ | 4u),
|
||||
lk->interp_cot, 0u, 1u, 1u, body, n, 0u);
|
||||
break;
|
||||
case 1u: /* YX 单点组 SQ=1,IOA 5..33 */
|
||||
for (i = 4u; i < 33u; i++) {
|
||||
iec104_pts_yx_read(i, &d);
|
||||
body[n++] = d;
|
||||
}
|
||||
rc = s_send_asdu(lk, IEC104_T_M_SP_NA_1, (uint8_t)(IEC104_VSQ_SQ | 29u),
|
||||
lk->interp_cot, 0u, 1u, 5u, body, n, 0u);
|
||||
break;
|
||||
case 2u: /* YC 组 SQ=1,IOA 0x4011..0x4018 */
|
||||
for (i = 0u; i < 8u; i++) {
|
||||
(void)iec104_pts_yc_read(i, &v, &qds);
|
||||
iec104_put_float(&body[n], v);
|
||||
n += 4u;
|
||||
body[n++] = qds;
|
||||
}
|
||||
rc = s_send_asdu(lk, IEC104_T_M_ME_NC_1, (uint8_t)(IEC104_VSQ_SQ | 8u),
|
||||
lk->interp_cot, 0u, 1u, 0x4011u, body, n, 0u);
|
||||
break;
|
||||
case 3u: /* 频率单点 SQ=0,IOA 0x401D */
|
||||
(void)iec104_pts_yc_read(8u, &v, &qds);
|
||||
iec104_put_float(&body[n], v);
|
||||
n += 4u;
|
||||
body[n++] = qds;
|
||||
rc = s_send_asdu(lk, IEC104_T_M_ME_NC_1, 1u, lk->interp_cot, 0u,
|
||||
1u, 0x401Du, body, n, 0u);
|
||||
break;
|
||||
default: /* actterm(仅总召;周期扫描不走这步) */
|
||||
iec104_put_ioa(&body[n], 0u);
|
||||
n += 3u;
|
||||
body[n++] = IEC104_RQT_GROUP1;
|
||||
rc = s_send_asdu(lk, IEC104_T_C_IC_NA_1, 1u, IEC104_COT_ACTTERM, 0u,
|
||||
0u, 0u, body, n, 0u);
|
||||
break;
|
||||
}
|
||||
if (rc != 0) {
|
||||
return -1; /* k 窗满:下次 poll 重试本 phase */
|
||||
}
|
||||
(*budget)--;
|
||||
lk->interp_yx_idx++;
|
||||
if (periodic != 0u) {
|
||||
if (lk->interp_yx_idx >= 4u) {
|
||||
lk->interp_step = 0u; /* 周期只发 YC(phase 2..3),无 actterm */
|
||||
}
|
||||
} else if (lk->interp_yx_idx >= 5u) {
|
||||
lk->interp_step = 0u;
|
||||
lk->init_pending = 0u;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:突发(COV)上送——pend 暂存逐点 SQ=0 COT=3,发成功才清位
|
||||
* 函数说明:单点遥信(idx≥4)自发用 **M_SP_TB_1**(SIQ + CP56Time2a,B9:
|
||||
* 变位带时标 = SOE 上送路径);双点(idx<4,V0.1 恒 IV)保持
|
||||
* M_DP_NA_1;总召/周期扫描仍走 s_scan_step 的 M_SP_NA_1/M_DP_NA_1
|
||||
* (时标只用于自发,标准语义——防"全量换型")。
|
||||
* 时标 = cfg->epoch_ms(ctx);NULL/UINT64_MAX → CP56 IV 位如实置位。
|
||||
*/
|
||||
static void s_spont_step(iec104_link_t *lk, uint8_t *budget) {
|
||||
uint8_t body[8]; /* 最大 = SIQ + CP56(7)(M_SP_TB_1) */
|
||||
uint8_t i;
|
||||
uint8_t d;
|
||||
uint8_t blen;
|
||||
uint8_t type;
|
||||
int rc;
|
||||
|
||||
while ((*budget > 0u) && ((lk->pend_yx != 0u) || (lk->pend_yc != 0u))) {
|
||||
if (lk->pend_yx != 0u) {
|
||||
i = 0u;
|
||||
while (i < 33u) {
|
||||
if ((lk->pend_yx & (1uLL << i)) != 0u) {
|
||||
break;
|
||||
}
|
||||
i++;
|
||||
}
|
||||
iec104_pts_yx_read(i, &d);
|
||||
body[0] = d;
|
||||
blen = 1u;
|
||||
if (i < 4u) {
|
||||
type = (uint8_t)IEC104_T_M_DP_NA_1;
|
||||
} else {
|
||||
uint64_t ems = (lk->cfg->epoch_ms != NULL)
|
||||
? lk->cfg->epoch_ms(lk->ctx)
|
||||
: UINT64_MAX;
|
||||
|
||||
type = (uint8_t)IEC104_T_M_SP_TB_1;
|
||||
(void)iec104_epoch_ms_to_cp56((ems == UINT64_MAX) ? 0u : ems,
|
||||
&body[1]);
|
||||
if (ems == UINT64_MAX) {
|
||||
body[1 + 2] |= 0x80u; /* CP56 byte2 bit7 IV:时钟无效如实上送 */
|
||||
}
|
||||
blen = 8u;
|
||||
}
|
||||
rc = s_send_asdu(lk, type, 1u, IEC104_COT_SPONT, 0u, 1u,
|
||||
(uint32_t)i + 1u, body, blen, 0u);
|
||||
if (rc != 0) {
|
||||
return; /* k 窗满:pend 位保留,下次续发 */
|
||||
}
|
||||
lk->pend_yx &= ~(1uLL << i);
|
||||
} else {
|
||||
i = 0u;
|
||||
while (i < 16u) {
|
||||
if ((lk->pend_yc & (uint16_t)(1u << i)) != 0u) {
|
||||
break;
|
||||
}
|
||||
i++;
|
||||
}
|
||||
rc = s_send_yc_single(lk, i, IEC104_COT_SPONT);
|
||||
if (rc != 0) {
|
||||
return;
|
||||
}
|
||||
lk->pend_yc &= (uint16_t)~(1u << i);
|
||||
}
|
||||
(*budget)--;
|
||||
}
|
||||
}
|
||||
|
||||
/* ---------------- 命令处理 ---------------- */
|
||||
|
||||
/*
|
||||
* 函数功能:C_IC_NA_1 总召处理(ACT → actcon + 启动扫描;DEACT → deactcon)
|
||||
* 说明:RBT(bit4)落在 COT 6bit 值域内,ACT+RBT 上收为 22——先剥再判;
|
||||
* 首召/RBT → COT=4(init),后续 COT=2(bg)
|
||||
*/
|
||||
static void s_h_ic(iec104_link_t *lk, const iec104_asdu_hdr_t *h) {
|
||||
/* RBT(bit4)落在 COT 6bit 值域内:ACT+RBT 上收为 22——先剥 RBT 再判值 */
|
||||
uint8_t cot_val = (uint8_t)(h->cot & 0xEFu);
|
||||
|
||||
if (cot_val == IEC104_COT_DEACT) {
|
||||
lk->interp_step = 0u;
|
||||
s_cmd_con(lk, IEC104_T_C_IC_NA_1, h->obj, h->obj_len,
|
||||
IEC104_COT_DEACTCON, 0u);
|
||||
return;
|
||||
}
|
||||
if (cot_val != IEC104_COT_ACT) {
|
||||
return;
|
||||
}
|
||||
if ((h->obj_len < 4u) || (h->obj[3] != IEC104_RQT_GROUP1)) {
|
||||
s_cmd_con(lk, IEC104_T_C_IC_NA_1, h->obj, h->obj_len,
|
||||
IEC104_COT_ACTCON, 1u);
|
||||
return;
|
||||
}
|
||||
s_cmd_con(lk, IEC104_T_C_IC_NA_1, h->obj, h->obj_len, IEC104_COT_ACTCON, 0u);
|
||||
lk->interp_step = 1u;
|
||||
lk->interp_yx_idx = 0u;
|
||||
lk->interp_cot = ((lk->init_pending != 0u)
|
||||
|| ((h->cot & IEC104_COT_BIT_RBT) != 0u))
|
||||
? (uint8_t)IEC104_COT_INIT : (uint8_t)IEC104_COT_BG_SCAN;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:C_CS_NA_1 对时(CP56 → epoch → cfg->clock_sync)
|
||||
* 说明:IV/字段坏/系统侧拒绝 → actcon + PN
|
||||
*/
|
||||
static void s_h_cs(iec104_link_t *lk, const iec104_asdu_hdr_t *h) {
|
||||
uint64_t epoch = 0u;
|
||||
int rc = -1;
|
||||
|
||||
if (h->obj_len >= 10u) {
|
||||
rc = iec104_cp56_to_epoch_ms(&h->obj[3], &epoch);
|
||||
if ((rc == 0) && (lk->cfg->clock_sync != NULL)) {
|
||||
rc = lk->cfg->clock_sync(lk->ctx, epoch);
|
||||
}
|
||||
}
|
||||
s_cmd_con(lk, IEC104_T_C_CS_NA_1, h->obj, h->obj_len, IEC104_COT_ACTCON,
|
||||
(rc == 0) ? 0u : 1u);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:C_DC_NA_1 遥控两段式(选择记 ioa+dpc;执行须匹配,否则 PN)
|
||||
*/
|
||||
static void s_h_dc(iec104_link_t *lk, const iec104_asdu_hdr_t *h) {
|
||||
uint32_t ioa;
|
||||
uint8_t qdc;
|
||||
uint8_t sel;
|
||||
uint8_t dpc;
|
||||
int rc;
|
||||
|
||||
if (h->obj_len < 4u) {
|
||||
return;
|
||||
}
|
||||
ioa = iec104_get_ioa(h->obj);
|
||||
qdc = h->obj[3];
|
||||
sel = (uint8_t)(((qdc & IEC104_QDC_S) != 0u) ? 1u : 0u);
|
||||
dpc = (uint8_t)(qdc & 0x03u);
|
||||
if (sel != 0u) {
|
||||
rc = iec104_pts_yk_exec(ioa, dpc, 1u);
|
||||
if (rc == 0) {
|
||||
lk->yk_sel_ioa = ioa;
|
||||
lk->yk_sel_dpc = dpc;
|
||||
}
|
||||
} else {
|
||||
if ((lk->yk_sel_ioa == ioa) && (lk->yk_sel_dpc == dpc)) {
|
||||
rc = iec104_pts_yk_exec(ioa, dpc, 0u);
|
||||
} else {
|
||||
rc = -1; /* 无选择/失配 → 否定确认 */
|
||||
}
|
||||
lk->yk_sel_ioa = 0u;
|
||||
lk->yk_sel_dpc = 0u;
|
||||
}
|
||||
s_cmd_con(lk, IEC104_T_C_DC_NA_1, h->obj, h->obj_len, IEC104_COT_ACTCON,
|
||||
(rc == 0) ? 0u : 1u);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:C_SE_NC_1 定值两段式写(选择段只校验;执行段落盘)
|
||||
* 说明:越界/未知地址 → actcon + PN
|
||||
*/
|
||||
static void s_h_se(iec104_link_t *lk, const iec104_asdu_hdr_t *h) {
|
||||
uint32_t addr;
|
||||
float v;
|
||||
uint8_t sel;
|
||||
int rc;
|
||||
|
||||
if (h->obj_len < 8u) {
|
||||
return;
|
||||
}
|
||||
addr = iec104_get_ioa(h->obj);
|
||||
v = iec104_get_float(&h->obj[3]);
|
||||
sel = (uint8_t)(((h->obj[7] & IEC104_QDC_S) != 0u) ? 1u : 0u);
|
||||
rc = iec104_pts_set_write(addr, v, sel);
|
||||
s_cmd_con(lk, IEC104_T_C_SE_NC_1, h->obj, h->obj_len, IEC104_COT_ACTCON,
|
||||
(rc == 0) ? 0u : 1u);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:C_RD_NA_1 读单个信息体(YC 命中 → M_ME COT5;定值命中 → 同;
|
||||
* 未知 IOA → 原样回 C_RD + COT14 + EVI)
|
||||
*/
|
||||
static void s_h_rd(iec104_link_t *lk, const iec104_asdu_hdr_t *h) {
|
||||
uint32_t ioa;
|
||||
uint8_t i;
|
||||
float v;
|
||||
|
||||
if (h->obj_len < 3u) {
|
||||
return;
|
||||
}
|
||||
ioa = iec104_get_ioa(h->obj);
|
||||
for (i = 0u; i < iec104_pts_yc_count(); i++) {
|
||||
if (iec104_pts_yc_ioa(i) == ioa) {
|
||||
s_send_yc_single(lk, i, IEC104_COT_REQ);
|
||||
return;
|
||||
}
|
||||
}
|
||||
if (iec104_pts_set_read(ioa, &v) == 0) {
|
||||
uint8_t body[5];
|
||||
|
||||
iec104_put_float(body, v);
|
||||
body[4] = 0u;
|
||||
(void)s_send_asdu(lk, IEC104_T_M_ME_NC_1, 1u, IEC104_COT_REQ, 0u,
|
||||
1u, ioa, body, 5u, 0u);
|
||||
return;
|
||||
}
|
||||
(void)s_send_asdu(lk, IEC104_T_C_RD_NA_1, 1u, IEC104_COT_UNK_IOA, 0u,
|
||||
1u, ioa, NULL, 0u, 1u);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:ASDU 分派(公共地址校验 → 类型路由)
|
||||
* 说明:错 ca → COT13+EVI;未知类型 → COT12+EVI(原类型回)
|
||||
*/
|
||||
static void s_h_asdu(iec104_link_t *lk, const uint8_t *asdu, uint16_t len) {
|
||||
iec104_asdu_hdr_t h;
|
||||
|
||||
if (iec104_asdu_parse_hdr(asdu, len, &h) != 0) {
|
||||
return;
|
||||
}
|
||||
if (h.ca != lk->cfg->ca) {
|
||||
(void)s_send_asdu(lk, h.type, 1u, IEC104_COT_UNK_CA, 0u,
|
||||
0u, 0u, NULL, 0u, 1u);
|
||||
return;
|
||||
}
|
||||
switch (h.type) {
|
||||
case IEC104_T_C_IC_NA_1:
|
||||
s_h_ic(lk, &h);
|
||||
break;
|
||||
case IEC104_T_C_CS_NA_1:
|
||||
s_h_cs(lk, &h);
|
||||
break;
|
||||
case IEC104_T_C_DC_NA_1:
|
||||
s_h_dc(lk, &h);
|
||||
break;
|
||||
case IEC104_T_C_SE_NC_1:
|
||||
s_h_se(lk, &h);
|
||||
break;
|
||||
case IEC104_T_C_RD_NA_1:
|
||||
s_h_rd(lk, &h);
|
||||
break;
|
||||
case IEC104_T_C_TS_NA_1:
|
||||
s_cmd_con(lk, IEC104_T_C_TS_NA_1, h.obj, h.obj_len,
|
||||
IEC104_COT_ACTCON, 0u);
|
||||
break;
|
||||
case IEC104_T_C_RP_NA_1:
|
||||
iec104_pts_cov_check(NULL); /* 进程复位:重建快照(清历史) */
|
||||
s_cmd_con(lk, IEC104_T_C_RP_NA_1, h.obj, h.obj_len,
|
||||
IEC104_COT_ACTCON, 0u);
|
||||
break;
|
||||
default:
|
||||
(void)s_send_asdu(lk, h.type, 1u, IEC104_COT_UNK_COT, 0u,
|
||||
0u, 0u, NULL, 0u, 1u);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* ---------------- APDU 分派 ---------------- */
|
||||
|
||||
/*
|
||||
* 函数功能:U 帧处理(STARTDT/STOPDT act → con + 态迁移;TESTFR act → con;
|
||||
* TESTFR con → 清挂起)
|
||||
*/
|
||||
static void s_h_u(iec104_link_t *lk, uint8_t q) {
|
||||
switch (q) {
|
||||
case U_STARTDT_ACT:
|
||||
s_send_u(lk, U_STARTDT_CON);
|
||||
lk->state = IEC104_ST_RUN;
|
||||
lk->interp_step = 0u;
|
||||
lk->yk_sel_ioa = 0u;
|
||||
break;
|
||||
case U_STOPDT_ACT:
|
||||
s_send_u(lk, U_STOPDT_CON);
|
||||
lk->state = IEC104_ST_STOPPED;
|
||||
lk->interp_step = 0u;
|
||||
break;
|
||||
case U_TESTFR_ACT:
|
||||
s_send_u(lk, U_TESTFR_CON);
|
||||
break;
|
||||
case U_TESTFR_CON:
|
||||
lk->testfr_pending = 0u;
|
||||
break;
|
||||
default:
|
||||
break; /* con/未知 U:t1/t3 已由外层刷新 */
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:N(R) 校验并更新 tx_unacked(V(A) ≤ V(A)' ≤ V(S),即 0 ≤ d ≤ 窗内)
|
||||
* 说明:N(R) 倒退(早于上次确认)= 协议违例 → 链路故障(标准语义);
|
||||
* tx_unacked 恒 ≤ k(发送侧门控),故 d ≤ tx_unacked 已蕴含窗校验
|
||||
* 返 回 值:0 / -1 违例
|
||||
*/
|
||||
static int s_apply_nr(iec104_link_t *lk, uint16_t nr) {
|
||||
uint16_t d = (uint16_t)(((uint32_t)lk->tx_seq + SEQ_MOD - (uint32_t)nr)
|
||||
% SEQ_MOD);
|
||||
|
||||
if ((uint32_t)d > (uint32_t)lk->tx_unacked) {
|
||||
return -1;
|
||||
}
|
||||
lk->tx_unacked = d;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:单个完整 APDU 分派(U/S/I);任何接收只刷 t3(不刷 t1)
|
||||
* 说明:OPEN 态只认 U;I 帧 N(S) 不连续 → IDLE;RUN 态才处理 ASDU;
|
||||
* 收满 w 个未确认 → 回 S
|
||||
*/
|
||||
static void s_h_apdu(iec104_link_t *lk, const uint8_t *p, uint16_t total) {
|
||||
const uint8_t *c = &p[2]; /* 控制域 4B */
|
||||
uint16_t ns;
|
||||
uint16_t nr;
|
||||
|
||||
lk->t3_deadline = lk->now_ms + IEC104_T3_MS;
|
||||
if ((c[0] & 0x03u) == 0x03u) {
|
||||
s_h_u(lk, c[0]);
|
||||
return;
|
||||
}
|
||||
if (lk->state == IEC104_ST_OPEN) {
|
||||
return; /* OPEN 态只认 U 帧 */
|
||||
}
|
||||
if ((c[0] & 0x01u) != 0u) { /* S 格式 */
|
||||
nr = (uint16_t)(((uint16_t)c[2] | ((uint16_t)c[3] << 8)) >> 1);
|
||||
if (s_apply_nr(lk, nr) != 0) {
|
||||
lk->state = IEC104_ST_IDLE;
|
||||
}
|
||||
return;
|
||||
}
|
||||
/* I 格式 */
|
||||
ns = (uint16_t)(((uint16_t)c[0] | ((uint16_t)c[1] << 8)) >> 1);
|
||||
nr = (uint16_t)(((uint16_t)c[2] | ((uint16_t)c[3] << 8)) >> 1);
|
||||
if (ns != lk->rx_seq) {
|
||||
lk->state = IEC104_ST_IDLE; /* 序号错 → 链路故障 */
|
||||
return;
|
||||
}
|
||||
if (s_apply_nr(lk, nr) != 0) {
|
||||
lk->state = IEC104_ST_IDLE;
|
||||
return;
|
||||
}
|
||||
lk->rx_seq = (uint16_t)((ns + 1u) % SEQ_MOD);
|
||||
lk->rx_unacked++;
|
||||
if (lk->rx_unacked == 1u) {
|
||||
lk->t2_deadline = lk->now_ms + IEC104_T2_MS;
|
||||
}
|
||||
if (lk->state == IEC104_ST_RUN) {
|
||||
s_h_asdu(lk, &p[6], (uint16_t)(total - 6u));
|
||||
}
|
||||
if (lk->rx_unacked >= IEC104_W_MAX) {
|
||||
s_send_s(lk);
|
||||
}
|
||||
}
|
||||
|
||||
/* ---------------- 公开接口 ---------------- */
|
||||
|
||||
/*
|
||||
* 函数功能:链路实例初始化(全清零 + 绑配置与上下文,态 = IDLE)
|
||||
*/
|
||||
void iec104_link_init(iec104_link_t *lk, const iec104_link_cfg_t *cfg,
|
||||
void *ctx) {
|
||||
(void)memset(lk, 0, sizeof(*lk));
|
||||
lk->cfg = cfg;
|
||||
lk->ctx = ctx;
|
||||
lk->state = IEC104_ST_IDLE;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:TCP 连接建立 → OPEN(序号/窗口/定时/暂存全部复位,init_pending=1)
|
||||
*/
|
||||
void iec104_link_open(iec104_link_t *lk, uint32_t now_ms) {
|
||||
lk->state = IEC104_ST_OPEN;
|
||||
lk->tx_seq = 0u;
|
||||
lk->rx_seq = 0u;
|
||||
lk->tx_unacked = 0u;
|
||||
lk->rx_unacked = 0u;
|
||||
lk->testfr_pending = 0u;
|
||||
lk->init_pending = 1u;
|
||||
lk->rx_len = 0u;
|
||||
lk->yk_sel_ioa = 0u;
|
||||
lk->yk_sel_dpc = 0u;
|
||||
lk->interp_step = 0u;
|
||||
lk->interp_yx_idx = 0u;
|
||||
lk->pend_yx = 0u;
|
||||
lk->pend_yc = 0u;
|
||||
lk->now_ms = now_ms;
|
||||
lk->t1_deadline = now_ms + IEC104_T1_MS;
|
||||
lk->t2_deadline = now_ms + IEC104_T2_MS;
|
||||
lk->t3_deadline = now_ms + IEC104_T3_MS;
|
||||
lk->period_next = now_ms + PERIOD_MS;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:链路断开/故障 → IDLE(清重组缓冲与所有暂存)
|
||||
*/
|
||||
void iec104_link_close(iec104_link_t *lk) {
|
||||
lk->state = IEC104_ST_IDLE;
|
||||
lk->rx_len = 0u;
|
||||
lk->interp_step = 0u;
|
||||
lk->pend_yx = 0u;
|
||||
lk->pend_yc = 0u;
|
||||
lk->yk_sel_ioa = 0u;
|
||||
lk->yk_sel_dpc = 0u;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:喂入收到的原始字节(APCI 流重组:半帧/粘帧逐处)
|
||||
* 说明:坏起始符/坏长度/缓冲溢出 → IDLE(胶水层检测后断开 socket)
|
||||
*/
|
||||
void iec104_link_on_rx(iec104_link_t *lk, const uint8_t *data, uint16_t len,
|
||||
uint32_t now_ms) {
|
||||
lk->now_ms = now_ms;
|
||||
if ((lk->state == IEC104_ST_IDLE) || (data == NULL)) {
|
||||
return;
|
||||
}
|
||||
if ((uint32_t)len > (uint32_t)(IEC104_RXBUF_SZ - lk->rx_len)) {
|
||||
lk->state = IEC104_ST_IDLE; /* 重组缓冲溢出 = 坏流 */
|
||||
lk->rx_len = 0u;
|
||||
return;
|
||||
}
|
||||
(void)memcpy(&lk->rx_buf[lk->rx_len], data, len);
|
||||
lk->rx_len = (uint16_t)(lk->rx_len + len);
|
||||
|
||||
while (lk->rx_len >= 2u) {
|
||||
uint16_t lf;
|
||||
uint16_t need;
|
||||
|
||||
if (lk->rx_buf[0] != APCI_START) {
|
||||
lk->state = IEC104_ST_IDLE;
|
||||
break;
|
||||
}
|
||||
lf = lk->rx_buf[1];
|
||||
if ((lf < APCI_LEN_MIN) || (lf > APCI_LEN_MAX)) {
|
||||
lk->state = IEC104_ST_IDLE;
|
||||
break;
|
||||
}
|
||||
need = (uint16_t)(lf + 2u);
|
||||
if (lk->rx_len < need) {
|
||||
break; /* 半帧:等下次 on_rx */
|
||||
}
|
||||
s_h_apdu(lk, lk->rx_buf, need);
|
||||
if (lk->state == IEC104_ST_IDLE) {
|
||||
break;
|
||||
}
|
||||
if (need < lk->rx_len) {
|
||||
(void)memmove(lk->rx_buf, &lk->rx_buf[need],
|
||||
(uint16_t)(lk->rx_len - need));
|
||||
}
|
||||
lk->rx_len = (uint16_t)(lk->rx_len - need);
|
||||
}
|
||||
if (lk->state == IEC104_ST_IDLE) {
|
||||
lk->rx_len = 0u;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:周期节拍(胶水层每次服务循环调用一次,时基由调用方注入)
|
||||
* 说明:t1 超时 → close;t3 到期 → TESTFR act;t2 到期 → S;
|
||||
* RUN 态按优先级:总召续扫 > 周期续扫 > COV 突发 > 周期触发
|
||||
*/
|
||||
void iec104_link_poll(iec104_link_t *lk, uint32_t now_ms) {
|
||||
uint8_t budget = IEC104_POLL_BUDGET;
|
||||
|
||||
lk->now_ms = now_ms;
|
||||
if ((lk->state != IEC104_ST_RUN) && (lk->state != IEC104_ST_STOPPED)) {
|
||||
return;
|
||||
}
|
||||
if (((lk->tx_unacked > 0u) || (lk->testfr_pending != 0u))
|
||||
&& (s_expired(now_ms, lk->t1_deadline) != 0)) {
|
||||
iec104_link_close(lk); /* t1:未确认 I/未答 TESTFR 超时 = 故障 */
|
||||
return;
|
||||
}
|
||||
if (s_expired(now_ms, lk->t3_deadline) != 0) {
|
||||
s_send_u(lk, U_TESTFR_ACT);
|
||||
}
|
||||
if ((lk->rx_unacked > 0u) && (s_expired(now_ms, lk->t2_deadline) != 0)) {
|
||||
s_send_s(lk);
|
||||
}
|
||||
if (lk->state != IEC104_ST_RUN) {
|
||||
return;
|
||||
}
|
||||
if (lk->interp_step == 1u) {
|
||||
while ((budget > 0u) && (lk->interp_step == 1u)) {
|
||||
if (s_scan_step(lk, &budget, 0u) != 0) {
|
||||
break; /* k 窗满:本 poll 停步(防死循环) */
|
||||
}
|
||||
}
|
||||
return;
|
||||
}
|
||||
if (lk->interp_step == 3u) {
|
||||
while ((budget > 0u) && (lk->interp_step == 3u)) {
|
||||
if (s_scan_step(lk, &budget, 1u) != 0) {
|
||||
break;
|
||||
}
|
||||
}
|
||||
return;
|
||||
}
|
||||
if ((lk->pend_yx != 0u) || (lk->pend_yc != 0u)) {
|
||||
s_spont_step(lk, &budget);
|
||||
if (budget == 0u) {
|
||||
return;
|
||||
}
|
||||
}
|
||||
if (s_expired(now_ms, lk->period_next) != 0) {
|
||||
lk->interp_step = 3u;
|
||||
lk->interp_yx_idx = 2u; /* 周期只扫 YC(phase 2..3) */
|
||||
lk->interp_cot = IEC104_COT_PERIODIC;
|
||||
lk->period_next = now_ms + PERIOD_MS;
|
||||
while ((budget > 0u) && (lk->interp_step == 3u)) {
|
||||
if (s_scan_step(lk, &budget, 1u) != 0) {
|
||||
break;
|
||||
}
|
||||
}
|
||||
return;
|
||||
}
|
||||
{
|
||||
iec104_pts_cov_t cov;
|
||||
|
||||
iec104_pts_cov_check(&cov);
|
||||
lk->pend_yx |= cov.yx_changed;
|
||||
lk->pend_yc |= cov.yc_changed;
|
||||
s_spont_step(lk, &budget);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:查询链路状态(胶水层检测 IDLE 跳变以断开/重建 socket)
|
||||
*/
|
||||
iec104_state_t iec104_link_state(const iec104_link_t *lk) {
|
||||
return lk->state;
|
||||
}
|
||||
@@ -1,142 +0,0 @@
|
||||
/*
|
||||
* 模块名称:IEC 60870-5-104 链路层(APCI + 状态机,纯逻辑)
|
||||
* 模块功能:TCP 流 → APDU 重组、U/S/I 帧编解码、STARTDT/STOPDT/TESTFR、
|
||||
* k/w 流量窗与 t1/t2/t3 超时、发送序号 N(S)/N(R) 管理,以及应用层
|
||||
* 流程编排:总召(act→背景扫描→actterm,首召 RBT 用 COT=4)、
|
||||
* 突发上送(COV,COT=3)、周期上送(COT=1)、读单个(C_RD→COT=5)、
|
||||
* 双点遥控两段式(选择/执行,失配否定确认 PN)、定值读(C_RD)/
|
||||
* 定值写(C_SE_NC 选择=范围校验 / 执行=写入+封存)、时钟同步(C_CS
|
||||
* → clock_sync 回调)、试验(C_TS)与进程复位(C_RP,清快照)。
|
||||
* **零 I/O**:收 = on_rx 喂 TCP 流片段,发 = send_apdu 回调,
|
||||
* 时基 = 调用方注入 now_ms(tick ms,回绕安全:差值法)
|
||||
* → 全栈(asdu+pts+link)主机侧纯逻辑单测可离线跑(分层约束)。
|
||||
* 参数(DL/T 634.5104 标准默认,§1.5 未另定):k=12 w=8 t1=15s t2=10s t3=20s。
|
||||
* 端口:TCP **2404** = 工厂默认(§1.5 B0 定义 / IEC 60870-5-104 标准端口;
|
||||
* 本 DTU = 被控站/服务器,主站连入)。真源与可改性见本文件下方 [comm] 段说明。
|
||||
* 线程约定:单实例单任务上下文(板端 = 104 服务在 netTask 消息循环内驱动,
|
||||
* 见 iec104_serv 胶水层);非线程安全,禁止多任务共享一实例。
|
||||
* 失败语义:send_apdu 内**不得阻塞**;发送失败由胶水层断链(主站会重连),
|
||||
* 本层不感知发送失败。
|
||||
* 创建日期:2026-10-12(B4)
|
||||
*/
|
||||
#ifndef IEC104_LINK_H
|
||||
#define IEC104_LINK_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#include "iec104_pts.h"
|
||||
|
||||
/* 服务端口真源已迁 [comm] 段(道G task-8):工厂默认 2404 = IEC104_COMM_DEF_PORT,
|
||||
* 运行期取 iec104_comm_port()(App/protocol/iec104/iec104_comm.h)。原死 define
|
||||
* IEC104_PORT 全仓零 .c 消费,2026-10-26 删除(旧引用见 docs/UI设计/页面扩充详细方案.md)。 */
|
||||
|
||||
/* 链路参数(标准默认值) */
|
||||
#define IEC104_K_MAX 12U /* 未确认 I 帧上限 */
|
||||
#define IEC104_W_MAX 8U /* 收到 I 帧未发确认的强制 S 阈值 */
|
||||
#define IEC104_T1_MS 15000UL /* 发送/确认超时(超时 = 链路故障) */
|
||||
#define IEC104_T2_MS 10000UL /* 无 I 发送时强制 S 确认超时(< t1) */
|
||||
#define IEC104_T3_MS 20000UL /* 空闲发 TESTFR 周期(< t1) */
|
||||
|
||||
/* TCP 流重组缓冲:APDU 上限 253 + 半帧余量 */
|
||||
#define IEC104_RXBUF_SZ 512U
|
||||
|
||||
/* 单次 poll 发送预算(ASDU 数)——防总召大扫描饿死宿主任务 */
|
||||
#define IEC104_POLL_BUDGET 4U
|
||||
|
||||
/* 链路状态 */
|
||||
typedef enum {
|
||||
IEC104_ST_IDLE = 0, /* TCP 未建立(或已断开) */
|
||||
IEC104_ST_OPEN, /* TCP 已建立,等 STARTDT act */
|
||||
IEC104_ST_RUN, /* STARTDT 已确认,数据服务开 */
|
||||
IEC104_ST_STOPPED /* STOPDT 已确认:停数据,保 S/TESTFR */
|
||||
} iec104_state_t;
|
||||
|
||||
/* 配置与回调(ctx 原样回传给回调) */
|
||||
typedef struct {
|
||||
uint16_t ca; /* 公共地址 = 链路地址(2B,§1.5) */
|
||||
/* 发一个完整 APDU(含 6B APCI 头)。不得阻塞;生命周期仅回调内有效 */
|
||||
void (*send_apdu)(void *ctx, const uint8_t *apdu, uint16_t len);
|
||||
/* C_CS 时钟同步:epoch 毫秒;NULL 或返回 -1 → 否定确认 */
|
||||
int (*clock_sync)(void *ctx, uint64_t epoch_ms);
|
||||
/* 时标源(B9):当前 epoch 毫秒(M_SP_TB_1 自发用)。
|
||||
* NULL 或返回 UINT64_MAX = 时钟无效 → CP56 IV 位如实置位。
|
||||
* 纯读(sys_clock 推算),不得阻塞、不得有副作用。 */
|
||||
uint64_t (*epoch_ms)(void *ctx);
|
||||
} iec104_link_cfg_t;
|
||||
|
||||
/* 链路实例(胶水层静态持有,零堆) */
|
||||
typedef struct {
|
||||
const iec104_link_cfg_t *cfg;
|
||||
void *ctx;
|
||||
iec104_state_t state;
|
||||
uint8_t init_pending; /* 1 = 下次总召按初始化(COT=4 + RBT) */
|
||||
/* 序号(0..32767,帧内 ×2) */
|
||||
uint16_t tx_seq;
|
||||
uint16_t rx_seq;
|
||||
uint16_t tx_unacked; /* 已发 I 未获认(k 窗) */
|
||||
uint16_t rx_unacked; /* 已收 I 未确认(w 阈) */
|
||||
uint8_t testfr_pending; /* 1 = TESTFR act 未获 con(t1 同样约束它) */
|
||||
/* 定时器到期时刻(now_ms 域;差值法判超时,回绕安全) */
|
||||
uint32_t t1_deadline;
|
||||
uint32_t t2_deadline;
|
||||
uint32_t t3_deadline;
|
||||
uint32_t now_ms;
|
||||
/* TCP 流重组 */
|
||||
uint8_t rx_buf[IEC104_RXBUF_SZ];
|
||||
uint16_t rx_len;
|
||||
/* 总召进度:0 无 / 1 背景扫描中 / 2 待发 actterm */
|
||||
uint8_t interp_step;
|
||||
uint8_t interp_yc_idx; /* 背景扫描 YC 游标 */
|
||||
uint8_t interp_yx_idx; /* 背景扫描 YX 游标 */
|
||||
uint8_t interp_cot; /* 本次总召用的 COT(BG_SCAN 或 INIT) */
|
||||
/* 遥控选择暂存(执行段比对) */
|
||||
uint32_t yk_sel_ioa; /* 0 = 无选择 */
|
||||
uint8_t yk_sel_dpc;
|
||||
/* 周期上送(COT=1)下次触发时刻 */
|
||||
uint32_t period_next;
|
||||
/* COV 待发暂存(k 窗满时保留到下次 poll,变化不许丢) */
|
||||
uint64_t pend_yx;
|
||||
uint16_t pend_yc;
|
||||
} iec104_link_t;
|
||||
|
||||
/*
|
||||
* 函数功能:初始化实例(置 IDLE、清序号;不发送任何帧)
|
||||
* 入口参数:lk - 实例;cfg/ctx - 配置与回调上下文
|
||||
*/
|
||||
void iec104_link_init(iec104_link_t *lk, const iec104_link_cfg_t *cfg, void *ctx);
|
||||
|
||||
/*
|
||||
* 函数功能:TCP 连接建立(新连接或重连后调用)
|
||||
* 入口参数:now_ms - 当前时基
|
||||
* 函数说明:序号清零、init_pending 置位(首召 = 初始化总召)、进 OPEN。
|
||||
*/
|
||||
void iec104_link_open(iec104_link_t *lk, uint32_t now_ms);
|
||||
|
||||
/*
|
||||
* 函数功能:TCP 断开(对端断开或胶水层发送失败主动断链时调用)
|
||||
* 函数说明:回 IDLE、清重组缓冲与选择暂存;不发送任何帧。
|
||||
*/
|
||||
void iec104_link_close(iec104_link_t *lk);
|
||||
|
||||
/*
|
||||
* 函数功能:喂入 TCP 收到的流片段(任意切分/粘帧)
|
||||
* 入口参数:data/len - 流片段;now_ms - 当前时基
|
||||
* 函数说明:内部重组,凑齐 APDU 即处理;坏帧(起始符/长度非法)→ 视同链路
|
||||
* 故障,实例回 IDLE(胶水层检测到 IDLE 跳变应断开 socket)。
|
||||
* 返回后实例仍为 RUN 不代表对端合法——仅表示未触发断链条件。
|
||||
*/
|
||||
void iec104_link_on_rx(iec104_link_t *lk, const uint8_t *data, uint16_t len,
|
||||
uint32_t now_ms);
|
||||
|
||||
/*
|
||||
* 函数功能:周期驱动(定时器 + COV + 总召分片 + 周期上送)
|
||||
* 入口参数:now_ms - 当前时基(建议 ≤100 ms 调一次)
|
||||
* 函数说明:仅 RUN 态产生数据帧;STOPPED 态只处理 t2/t3(S/TESTFR)。
|
||||
* 单次调用发送量 ≤ IEC104_POLL_BUDGET 个 ASDU。
|
||||
*/
|
||||
void iec104_link_poll(iec104_link_t *lk, uint32_t now_ms);
|
||||
|
||||
/* 当前状态(日志/看门狗用) */
|
||||
iec104_state_t iec104_link_state(const iec104_link_t *lk);
|
||||
|
||||
#endif /* IEC104_LINK_H */
|
||||
@@ -0,0 +1,656 @@
|
||||
/* 模块名称:IEC 60870-5-104 板端 Net 后端(netTask 单 owner) */
|
||||
/*
|
||||
* 模块功能:实现 App/protocol/iec60870/104/IEC104_Net.h 的全部导出 ABI,
|
||||
* 底层走 Drivers/BSP/NET/net_socket.h 的 net_* 接口。
|
||||
* 适用平台:STM32F407ZGTx + CH395F;只在 netTask 上下文中调用(threadless)。
|
||||
* 创建日期:2026-11-17(task-18 板端网络割接)
|
||||
*
|
||||
* Verification scope (ASCII note): this is the ONLY 104 component NOT built
|
||||
* or exercised by the simulator; the simulator provides the same ABI via
|
||||
* sim/iec104_sim.c. This file is verified ONLY by fake-net tests (12/12) plus
|
||||
* code review; CH395F on-board behaviour remains UNPROVEN.
|
||||
*
|
||||
* 三条硬纪律:
|
||||
* 1. 零阻塞:不投 netMsgQueue、不用 osWaitForever、不睡任务通知、不帮忙 pump;
|
||||
* 2. 零借用:所有 Send 在返回前数据已交给 net 层/芯片,不缓存调用方指针;
|
||||
* 3. 同 fd 映射:CH395F 单连接模型下 net_accept() 返回监听 fd 自己,
|
||||
* CLIENT 的 Close 只调 net_drop_conn_locked(拆会话保监听),
|
||||
* 本文件的 CLIENT 分支里不存在任何关闭监听 fd 的路径。
|
||||
*
|
||||
* 句柄设计(Lead 2026-11-17 裁定):IEC104_NetSocket_t 只有 uintptr_t 一个整数,
|
||||
* 无法携带 session 身份,因此采用「单调递增句柄值 + 8 项映射表,句柄永不复用」:
|
||||
* 每次 Listen/Accept 成功都分配新的 handle 值,旧 handle 永远不会再次出现在表中。
|
||||
* 连续 3 次 listen/close 后旧 handle 必然查表失败,构造性反例自证见 MATRIX N6。
|
||||
*
|
||||
* 代次不变量(task-18 定案):后端槽的有效性只由
|
||||
* `slot->net_gen == net_get_generation()` 判定;网络初始化(net_stack_bring_up)
|
||||
* 复位芯片并清空 net 层控制块后,旧句柄一律失效,后端绝不向跨代次的 fd
|
||||
* 发任何硬件操作(包括 net_close_sock)。net_generation_inc 只在 net_init
|
||||
* 成功、芯片已复位之后调用,因此"代次已变"即代表"旧 fd 已不存在"。
|
||||
*
|
||||
* fd 归属规则(三个 P1 的共同根因,任何资源操作前先回答"这个 fd 此刻代表谁"):
|
||||
* 1. 监听 fd 在任何时刻只被 LISTEN 槽引用,LISTEN 槽 handle 终身不变;
|
||||
* 2. Accept 成功的瞬间该 fd 语义从"监听"变为"数据通道",旧 client 槽同时
|
||||
* 失效——必须**只清槽不 drop_conn**,因为此刻同 fd 已是新连接的
|
||||
* ESTABLISHED,drop 会拆掉刚接进来的新连接;
|
||||
* 3. 任何 net_drop_conn_locked 调用前必须确认"该 fd 当前仍属于我要拆的
|
||||
* 那个会话",仅凭 fd 状态是 ESTABLISHED 不足以判定归属。同一 fd 在不同
|
||||
* 时刻分属不同代次/会话,跨代旧槽的 fd 号可能已复用,绝不能对它操作。
|
||||
*/
|
||||
#include "IEC104_Net.h"
|
||||
#include "net_socket.h"
|
||||
#include <string.h>
|
||||
|
||||
/* 映射表容量 = net 层 fd 数上限(NET_MAX_SOCKETS=8)。 */
|
||||
#define IEC104_MCU_MAP_SIZE 8U
|
||||
|
||||
typedef enum {
|
||||
SLOT_FREE = 0,
|
||||
SLOT_LISTEN,
|
||||
SLOT_CLIENT,
|
||||
SLOT_CLIENT_EOF
|
||||
} slot_role_t;
|
||||
|
||||
typedef struct {
|
||||
uintptr_t handle; /* 0 = 空闲;非 0 单调,不复用 */
|
||||
int fd; /* net 层 fd,同 fd 模型下 LISTEN/CLIENT 相同 */
|
||||
uint32_t net_gen; /* 成功 Listen 时的网络代次,跨代旧句柄一律失效 */
|
||||
uint8_t role; /* slot_role_t */
|
||||
} slot_t;
|
||||
|
||||
static slot_t s_slots[IEC104_MCU_MAP_SIZE];
|
||||
static uintptr_t s_next_handle = 1U;
|
||||
static uint8_t s_inited;
|
||||
|
||||
/* rx_bytes 唯一后端计数:Recv 返回 OK 时按 transferred 累加,饱和 0xFFFFFFF0。 */
|
||||
static uint32_t s_rx_bytes;
|
||||
|
||||
#define STAT_SAT 0xFFFFFFF0u
|
||||
|
||||
/* 函数功能:把「ABI 返回码 + 底层 errno」打包成一次返回,顺带回写可选的原生错误出参。
|
||||
* 参数:code ABI 返回码;native_error 底层 errno(仅出参用);out 原生错误出参,可传 NULL。
|
||||
* 返回值:原样返回 code(便于 `return result(...)` 单行收尾,避免各处重复写 out 判空)。 */
|
||||
static IEC104_NetResult_t result(IEC104_NetResult_t code, int native_error, int *out)
|
||||
{
|
||||
if (out != NULL) {
|
||||
*out = native_error;
|
||||
}
|
||||
return code;
|
||||
}
|
||||
|
||||
/* 函数功能:32 位饱和加法,用于接收字节数累加(到达上限后钉住,绝不回绕成小数)。
|
||||
* 参数:value 被累加的计数器;delta 本次增量。
|
||||
* 返回值:无(只改 *value)。 */
|
||||
static void sat_add(uint32_t *value, uint32_t delta)
|
||||
{
|
||||
/* 先判 *value 已达上限,再做差值比较:保证 STAT_SAT - *value 不会下溢,
|
||||
* delta 无论多大都只会把计数钉在饱和值,绝不回绕成小数。 */
|
||||
if (*value >= STAT_SAT || delta >= STAT_SAT - *value) {
|
||||
*value = STAT_SAT;
|
||||
} else {
|
||||
*value += delta;
|
||||
}
|
||||
}
|
||||
|
||||
/* 句柄查表:同时校验 owner、初始化状态、句柄存在、role 与网络代次。
|
||||
* 失败一律返回 NULL,不触碰任何硬件/连接。
|
||||
* 槽内 net_gen 是句柄有效性的唯一代次来源:网络自愈使 net_generation_inc()
|
||||
* 递增后,所有旧槽的代次一次性过期,无需全局基线(也避免"重建依赖 find"的
|
||||
* 循环依赖)。
|
||||
* 两句柄模型(task-18 第三轮):监听槽与客户端槽是**两个独立槽**。监听槽
|
||||
* role 恒为 LISTEN、handle 在整段监听生命周期内不变(库侧 server->listen_socket
|
||||
* 在 Listen 后固定,不会随会话更新);每次 Accept 另起一个 CLIENT 槽、分新
|
||||
* handle。绝不翻转监听槽的 role,否则库的 Close(listen)/Wait(ACCEPT) 会失联。 */
|
||||
static slot_t *find_role(uintptr_t handle, uint8_t role)
|
||||
{
|
||||
uint32_t i;
|
||||
uint32_t gen = net_get_generation();
|
||||
if (s_inited == 0U || handle == 0U || handle == IEC104_NET_INVALID_SOCKET ||
|
||||
net_ctx_is_owner_task() == 0U) {
|
||||
return NULL;
|
||||
}
|
||||
for (i = 0U; i < IEC104_MCU_MAP_SIZE; ++i) {
|
||||
slot_t *slot = &s_slots[i];
|
||||
if (slot->handle == handle && slot->role == role &&
|
||||
slot->net_gen == gen) {
|
||||
return slot;
|
||||
}
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* 客户端句柄查表:CLIENT 与 CLIENT_EOF 都算命中。EOF 后库仍可能排空待发
|
||||
* 应答(Prepare_Output 在 rx_eof 下先发完再 Drop),Send 必须在 EOF 状态下
|
||||
* 仍可用,不能因 role=CLIENT_EOF 就报 BADF。 */
|
||||
static slot_t *find_client(uintptr_t handle)
|
||||
{
|
||||
slot_t *slot = find_role(handle, SLOT_CLIENT);
|
||||
if (slot == NULL) {
|
||||
slot = find_role(handle, SLOT_CLIENT_EOF);
|
||||
}
|
||||
return slot;
|
||||
}
|
||||
|
||||
/* 取空闲槽(handle==0 且 role==FREE)。只判 handle==0 会把刚 Close(listen)
|
||||
* memset 过的监听槽误当空闲并覆盖,导致 Accept 把监听资源吃掉。 */
|
||||
static slot_t *slot_alloc_free(void)
|
||||
{
|
||||
uint32_t i;
|
||||
for (i = 0U; i < IEC104_MCU_MAP_SIZE; ++i) {
|
||||
if (s_slots[i].handle == 0U && s_slots[i].role == SLOT_FREE) {
|
||||
return &s_slots[i];
|
||||
}
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* 找当前仍挂着的客户端槽(CLIENT 或 CLIENT_EOF),供 Accept 防重入清理。
|
||||
* 只认当前代次:跨代旧槽的 fd 号可能已复用,对它调 net_sock_state/drop_conn
|
||||
* 会违反文件头的 fd 归属规则。 */
|
||||
static slot_t *client_slot_find_any(void)
|
||||
{
|
||||
uint32_t i;
|
||||
uint32_t gen = net_get_generation();
|
||||
for (i = 0U; i < IEC104_MCU_MAP_SIZE; ++i) {
|
||||
if ((s_slots[i].role == SLOT_CLIENT || s_slots[i].role == SLOT_CLIENT_EOF) &&
|
||||
s_slots[i].net_gen == gen) {
|
||||
return &s_slots[i];
|
||||
}
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* 函数功能:拆掉一个客户端槽——**只拆会话、保监听**。
|
||||
* 参数:slot 要拆除的客户端槽(必须是 SLOT_CLIENT / SLOT_CLIENT_EOF)。
|
||||
* 返回值:无。
|
||||
*
|
||||
* drop_conn 的 APP_ASSERT 要求 ESTABLISHED/CONNECTING;先判状态,EOF/DISCONNECT
|
||||
* 等其它状态只清槽、跳过拆除(auto_relisten 已接管)。本函数绝不触碰监听槽、
|
||||
* 绝不调 net_close_sock。Accept 与 Close(client) 共用同一套拆除逻辑,
|
||||
* 避免两份实现漂移。 */
|
||||
static void client_slot_drop(slot_t *slot)
|
||||
{
|
||||
int state;
|
||||
/* 代次自锁:跨代槽的 fd 号可能已被复用,绝不能对它做任何硬件读取/拆除。 */
|
||||
if (slot->net_gen != net_get_generation()) {
|
||||
memset(slot, 0, sizeof(*slot));
|
||||
return;
|
||||
}
|
||||
state = net_sock_state(slot->fd);
|
||||
if (state == NET_SOCK_STATE_ESTABLISHED || state == NET_SOCK_STATE_CONNECTING) {
|
||||
net_sock_t *sock = net_get_sock(slot->fd);
|
||||
if (sock != NULL) {
|
||||
(void)net_drop_conn_locked(sock);
|
||||
}
|
||||
}
|
||||
/* 只清客户端槽;监听槽的 handle/fd/net_gen/role 原地不动。 */
|
||||
memset(slot, 0, sizeof(*slot));
|
||||
}
|
||||
|
||||
/* 函数功能:分配一个新句柄值(单调递增、永不复用),必要时先整表作废重启。
|
||||
* 参数:无。
|
||||
* 返回值:新句柄(非 0,且一定不在任何现存槽中)。
|
||||
*
|
||||
* UINTPTR_MAX 前保留一个溢出保护窗口,届时整表作废并重新开始——运行 2^32 次
|
||||
* 接入远大于设备寿命,仅作防御。 */
|
||||
static uintptr_t handle_new(void)
|
||||
{
|
||||
uintptr_t h = s_next_handle;
|
||||
if (h >= (uintptr_t)(UINTPTR_MAX - IEC104_MCU_MAP_SIZE)) {
|
||||
memset(s_slots, 0, sizeof(s_slots));
|
||||
h = 1U;
|
||||
}
|
||||
s_next_handle = h + 1U;
|
||||
return h;
|
||||
}
|
||||
|
||||
IEC104_NetResult_t IEC104_Net_Init(int *native_error)
|
||||
{
|
||||
if (net_ctx_is_owner_task() == 0U) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
/* Init 是运行期起点:net_stack_bring_up 已先 net_init(芯片硬复位 +
|
||||
* net 层 s_net_socks 全清)后递增代次,上一运行期的底层 fd 已不存在。
|
||||
* 这里只清后端映射表、不向任何旧 fd 发 net_close_sock——fd 号可能已被
|
||||
* 复用,误关会打掉新会话。不变量见本文件头。 */
|
||||
memset(s_slots, 0, sizeof(s_slots));
|
||||
s_next_handle = 1U;
|
||||
s_rx_bytes = 0U;
|
||||
s_inited = 1U;
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
|
||||
void IEC104_Net_Cleanup(void)
|
||||
{
|
||||
/* 不关 socket:调用方(TcpServer)负责先 Close 自己持有的句柄。 */
|
||||
s_inited = 0U;
|
||||
}
|
||||
|
||||
int IEC104_Net_Invalid_Argument_Error(void)
|
||||
{
|
||||
return NET_ERR_INVAL;
|
||||
}
|
||||
|
||||
IEC104_NetResult_t IEC104_Net_Listen(
|
||||
const char *bind_address, uint16_t port, IEC104_NetSocket_t *listener,
|
||||
uint16_t *bound_port, int *native_error)
|
||||
{
|
||||
int fd, rc, addrlen;
|
||||
uint32_t i;
|
||||
uint32_t ip;
|
||||
struct net_sockaddr_in addr;
|
||||
slot_t *slot = NULL;
|
||||
|
||||
if (s_inited == 0U || bind_address == NULL || listener == NULL ||
|
||||
bound_port == NULL || net_ctx_is_owner_task() == 0U) {
|
||||
*listener = IEC104_NET_INVALID_SOCKET;
|
||||
*bound_port = 0U;
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
*listener = IEC104_NET_INVALID_SOCKET;
|
||||
*bound_port = 0U;
|
||||
/* 代次闸(网络自愈):net_stack_bring_up 先 net_init(芯片硬复位、
|
||||
* net 层 s_net_socks 清零)后 net_generation_inc;旧槽的 fd 已不存在,
|
||||
* 且 fd 号可能被本次重建复用。这里只清表、绝不向旧 fd 发硬件关闭,
|
||||
* 避免误伤同号的新 socket。清表后旧句柄一律 find 失败;重建不依赖
|
||||
* Close 成功,serv tick 直接强制重起 core。不变量见本文件头。 */
|
||||
{
|
||||
uint32_t gen = net_get_generation();
|
||||
for (i = 0U; i < IEC104_MCU_MAP_SIZE; ++i) {
|
||||
if (s_slots[i].handle != 0U && s_slots[i].net_gen != gen) {
|
||||
memset(&s_slots[i], 0, sizeof(s_slots[i]));
|
||||
}
|
||||
}
|
||||
}
|
||||
/* CH395F 单宿主:只接受数字 IPv4;net_inet_addr 把 "0.0.0.0" 也解析成 0。 */
|
||||
ip = net_inet_addr(bind_address);
|
||||
if (ip == 0U && strcmp(bind_address, "0.0.0.0") != 0) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
fd = net_socket(NET_AF_INET, NET_SOCK_STREAM);
|
||||
if (fd < 0) {
|
||||
return result(IEC104_NET_ERROR, net_get_errno(), native_error);
|
||||
}
|
||||
memset(&addr, 0, sizeof(addr));
|
||||
addr.sin_family = NET_AF_INET;
|
||||
addr.sin_port = net_htons(port);
|
||||
addr.sin_addr.s_addr = ip;
|
||||
addrlen = (int)sizeof(addr);
|
||||
rc = net_bind(fd, (const struct net_sockaddr *)&addr, addrlen);
|
||||
if (rc == 0) {
|
||||
/* 公开 net_listen() 是队列版,在 netTask 内自等死锁;用 owner 出口。 */
|
||||
rc = net_listen_locked(fd);
|
||||
}
|
||||
if (rc != 0) {
|
||||
int code = net_get_errno();
|
||||
(void)net_close_sock(net_get_sock(fd));
|
||||
return result(IEC104_NET_ERROR, (code < 0) ? code : NET_ERR, native_error);
|
||||
}
|
||||
(void)net_setblocking(fd, 0);
|
||||
slot = slot_alloc_free();
|
||||
if (slot == NULL) {
|
||||
(void)net_close_sock(net_get_sock(fd));
|
||||
return result(IEC104_NET_ERROR, NET_ERR_NOMEM, native_error);
|
||||
}
|
||||
slot->handle = handle_new();
|
||||
slot->fd = fd;
|
||||
slot->net_gen = net_get_generation();
|
||||
slot->role = SLOT_LISTEN;
|
||||
*listener = slot->handle;
|
||||
*bound_port = port;
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
|
||||
IEC104_NetResult_t IEC104_Net_Accept(
|
||||
IEC104_NetSocket_t listener, IEC104_NetSocket_t *client,
|
||||
IEC104_NetPeer_t *peer, int *native_error)
|
||||
{
|
||||
slot_t *slot = find_role(listener, SLOT_LISTEN);
|
||||
struct net_sockaddr_in addr;
|
||||
int addrlen = (int)sizeof(addr);
|
||||
int rc;
|
||||
char ip_text[16];
|
||||
slot_t *client_slot;
|
||||
|
||||
if (client == NULL || peer == NULL) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
*client = IEC104_NET_INVALID_SOCKET;
|
||||
if (slot == NULL) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
/* 单 fd 模型的 accept 一次性语义(2026-11-18 板端实测事故,两层伤害,必读):
|
||||
* ① net 层 net_accept_locked 对 ESTABLISHED 的监听 fd 幂等返回成功
|
||||
* (net_socket.c:1391 只在 state != ESTABLISHED 才进 WOULDBLOCK 分支);
|
||||
* ② 库 Accept_Clients 的 4 次预算循环(IEC104_TcpServer.c:330/:1563)
|
||||
* 在第 2..4 次迭代跳过 client_socket != INVALID 的全部前置判据
|
||||
* (:1570-1578),直接再调本函数,随后按"多余客户端"关掉它
|
||||
* (:1605-1607)。
|
||||
* 若在这里再发新句柄,会连环受伤:第 1 次 Accept 交付 H1,库在 :1670
|
||||
* 记住它;第 2 次进来若清/重分配 H1 所在槽,H1 立即悬空(slot_by_handle
|
||||
* 返回 NULL,STARTDT_ACT 的 Send(H1) 报 NET_ERR_BADF → Drop_Client,
|
||||
* 这是"STARTDT 一点回应都没有 + 20~33ms EOF"的第一击);即便不清旧槽而是
|
||||
* 另开 H2,库仍会在 :1606 Close(client) 把与监听同 fd 的会话拆掉(第二击)。
|
||||
* 因此同一会话只交付一次:当前代次已有 CLIENT/CLIENT_EOF 槽时一律
|
||||
* WOULD_BLOCK(库对该码的处理是 accept_pending=0、本轮正常返回,
|
||||
* :1583-1588),绝不用 RETRY_LATER(那会 Pause_Accept 100ms)。
|
||||
* 【位置】闸放在 net_listener_armed 之前:client_slot_find_any 是纯 RAM
|
||||
* 判断,保证会话已存在时一次芯片事务都不发(armed 之后紧跟的
|
||||
* net_accept_locked 会 net_poll() 走 SPI)。
|
||||
* 【EOF 窗口】client_slot_find_any 同时认 SLOT_CLIENT_EOF:EOF 之后、
|
||||
* 库 Drop_Client 之前那段收尾窗口同样必须挡住,否则新连接会被旧会话
|
||||
* 收尾拆掉。
|
||||
* 【残留保险】即便异常路径真留下槽,下一次 core start 的 IEC104_Net_Init()
|
||||
* 会 memset 整张 s_slots 表,不会永久静默拒连。 */
|
||||
if (client_slot_find_any() != NULL) {
|
||||
return result(IEC104_NET_WOULD_BLOCK, 0, native_error);
|
||||
}
|
||||
/* accept 门控:未 armed 时直接 WOULD_BLOCK,不做任何芯片访问。 */
|
||||
if (net_listener_armed(slot->fd) == 0) {
|
||||
return result(IEC104_NET_WOULD_BLOCK, 0, native_error);
|
||||
}
|
||||
memset(&addr, 0, sizeof(addr));
|
||||
rc = net_accept_locked(slot->fd, (struct net_sockaddr *)&addr, &addrlen);
|
||||
if (rc < 0) {
|
||||
int code = net_get_errno();
|
||||
if (code == NET_ERR_WOULDBLOCK) {
|
||||
return result(IEC104_NET_WOULD_BLOCK, code, native_error);
|
||||
}
|
||||
if (code == NET_ERR_NOMEM || code == NET_ERR_BUSY) {
|
||||
return result(IEC104_NET_RETRY_LATER, code, native_error);
|
||||
}
|
||||
return result(IEC104_NET_RETRY, code, native_error);
|
||||
}
|
||||
/* 单连接模型:rc == listener fd(监听槽的 fd 原地转为数据通道)。
|
||||
* 监听槽 role 恒为 LISTEN、handle 不变;本次连接另起 CLIENT 槽。
|
||||
* 单 fd 下库可能重复 Accept,一次性闸在上面:此处不得清理既有槽——
|
||||
* 旧槽可能是库正持有的句柄(清掉即悬空),故原"先清旧槽再分配"段已删。 */
|
||||
client_slot = slot_alloc_free();
|
||||
if (client_slot == NULL) {
|
||||
/* 槽耗尽(理论上:8 槽内 1 监听 + 至多 1 客户端不应到这):按资源暂缺
|
||||
* 退回,让库暂停接入 100 ms 后重试;本次不建会话,不碰芯片。 */
|
||||
return result(IEC104_NET_RETRY_LATER, NET_ERR_NOMEM, native_error);
|
||||
}
|
||||
memset(peer, 0, sizeof(*peer));
|
||||
/* net_accept_locked 把 addrlen 回写为实际结构长度(IPv4 = sizeof(net_sockaddr_in)),
|
||||
* 不是调用前的容量。按最小可用长度判,不再用 >= sizeof(addr) 把真实值挡掉。 */
|
||||
if (addrlen >= (int)(sizeof(addr.sin_family) + sizeof(addr.sin_port) +
|
||||
sizeof(addr.sin_addr)) &&
|
||||
addr.sin_family == NET_AF_INET) {
|
||||
(void)net_inet_ntoa(addr.sin_addr.s_addr, ip_text);
|
||||
/* 点分串最长 15 字符 + NUL,固定 16 字节缓冲足够 */
|
||||
(void)memcpy(peer->address, ip_text, sizeof(peer->address));
|
||||
peer->port = net_ntohs(addr.sin_port);
|
||||
}
|
||||
/* CLIENT 槽与监听槽同 fd、同代次(Accept 不换代次);独立 handle 使库的
|
||||
* listen_socket/client_socket 两个字段各自稳定,互不覆盖。 */
|
||||
client_slot->handle = handle_new();
|
||||
client_slot->fd = slot->fd;
|
||||
client_slot->net_gen = slot->net_gen;
|
||||
client_slot->role = SLOT_CLIENT;
|
||||
/* CH395F 无 Nagle 开关(net 层没有 setsockopt 面),硬件即无延迟确认策略;
|
||||
* 不以 NODELAY 作为接入 OK 条件,也不假装设置成功。 */
|
||||
*client = client_slot->handle;
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
|
||||
IEC104_NetIoResult_t IEC104_Net_Recv(
|
||||
IEC104_NetSocket_t socket_handle, void *data, size_t capacity)
|
||||
{
|
||||
IEC104_NetIoResult_t out;
|
||||
slot_t *slot;
|
||||
net_sock_t *sock;
|
||||
int rc, code;
|
||||
|
||||
out.result = IEC104_NET_ERROR;
|
||||
out.transferred = 0U;
|
||||
out.native_error = 0;
|
||||
/* 非 owner 上下文是调用契约违规(本后端 threadless,只允许 netTask),
|
||||
* 与"句柄无效"分开报 ERROR+NET_ERR_INVAL,禁止下游据此碰芯片。 */
|
||||
if (net_ctx_is_owner_task() == 0U) {
|
||||
out.native_error = NET_ERR_INVAL;
|
||||
return out;
|
||||
}
|
||||
if (data == NULL || capacity == 0U || capacity > 0x7FFFFFFFu) {
|
||||
out.native_error = NET_ERR_INVAL;
|
||||
return out;
|
||||
}
|
||||
slot = find_client(socket_handle);
|
||||
if (slot == NULL) {
|
||||
out.native_error = (s_inited == 0U) ? NET_ERR_INVAL : NET_ERR_BADF;
|
||||
return out;
|
||||
}
|
||||
sock = net_get_sock(slot->fd);
|
||||
if (sock == NULL) {
|
||||
out.native_error = NET_ERR_BADF;
|
||||
return out;
|
||||
}
|
||||
rc = net_recv_sock(sock, data, (int)capacity, NET_MSG_DONTWAIT);
|
||||
if (rc > 0) {
|
||||
out.result = IEC104_NET_OK;
|
||||
out.transferred = (size_t)rc;
|
||||
sat_add(&s_rx_bytes, (uint32_t)rc);
|
||||
return out;
|
||||
}
|
||||
if (rc == 0) {
|
||||
/* 只读 EOF 事实:槽角色保持 CLIENT_EOF,绝不置回 LISTEN——
|
||||
* 否则紧随其后的 Close 会落到 LISTEN 分支真关监听(不可逆事故)。 */
|
||||
slot->role = SLOT_CLIENT_EOF;
|
||||
out.result = IEC104_NET_EOF;
|
||||
return out;
|
||||
}
|
||||
code = net_get_errno();
|
||||
if (code == NET_ERR_WOULDBLOCK) {
|
||||
out.result = IEC104_NET_WOULD_BLOCK;
|
||||
out.native_error = code;
|
||||
return out;
|
||||
}
|
||||
if (code == NET_ERR_BUSY || code == NET_ERR_CONNRESET) {
|
||||
out.result = IEC104_NET_RETRY;
|
||||
out.native_error = code;
|
||||
return out;
|
||||
}
|
||||
out.native_error = (code < 0) ? code : NET_ERR;
|
||||
return out;
|
||||
}
|
||||
|
||||
IEC104_NetResult_t IEC104_Net_Pending_Input(
|
||||
IEC104_NetSocket_t socket_handle, uint32_t *available, int *native_error)
|
||||
{
|
||||
slot_t *slot;
|
||||
int len;
|
||||
if (net_ctx_is_owner_task() == 0U) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
if (available == NULL) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
slot = find_client(socket_handle);
|
||||
if (slot == NULL) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_BADF, native_error);
|
||||
}
|
||||
len = net_pending_bytes(slot->fd);
|
||||
if (len < 0) {
|
||||
/* 精确失败:查不到就是查不到,不谎报 0/1,由 TcpServer 按 EOF 收口。 */
|
||||
return result(IEC104_NET_ERROR, net_get_errno(), native_error);
|
||||
}
|
||||
*available = (uint32_t)len;
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
|
||||
IEC104_NetIoResult_t IEC104_Net_Send(
|
||||
IEC104_NetSocket_t socket_handle, const void *data, size_t length)
|
||||
{
|
||||
IEC104_NetIoResult_t out;
|
||||
slot_t *slot;
|
||||
net_sock_t *sock;
|
||||
int sent = 0, rc, code;
|
||||
|
||||
out.result = IEC104_NET_ERROR;
|
||||
out.transferred = 0U;
|
||||
out.native_error = 0;
|
||||
if (net_ctx_is_owner_task() == 0U) {
|
||||
out.native_error = NET_ERR_INVAL;
|
||||
return out;
|
||||
}
|
||||
if (length > 0x7FFFFFFFu) {
|
||||
out.native_error = NET_ERR_INVAL;
|
||||
return out;
|
||||
}
|
||||
slot = find_client(socket_handle);
|
||||
if (slot == NULL) {
|
||||
out.native_error = NET_ERR_BADF;
|
||||
return out;
|
||||
}
|
||||
/* ABI 允许 OK + transferred=0(无进展)。库当前不会主动传 0,
|
||||
* 但 0 长度调用按"无数据可发、无原生错误"返回,避免误判成发送失败。 */
|
||||
if (length == 0U) {
|
||||
out.result = IEC104_NET_OK;
|
||||
return out;
|
||||
}
|
||||
sock = net_get_sock(slot->fd);
|
||||
if (sock == NULL) {
|
||||
out.native_error = NET_ERR_BADF;
|
||||
return out;
|
||||
}
|
||||
rc = net_send_try(sock, data, (int)length, &sent);
|
||||
if (rc == 0) {
|
||||
/* OK + 0 或短写均按实际 transferred 上报,由库按 remaining_bytes 续发;
|
||||
* 后端绝不从 Send 次数或短写推断帧完成/帧失败。 */
|
||||
out.result = IEC104_NET_OK;
|
||||
out.transferred = (size_t)sent;
|
||||
return out;
|
||||
}
|
||||
code = (rc < 0) ? net_get_errno() : NET_ERR;
|
||||
if (code == NET_ERR_WOULDBLOCK) {
|
||||
out.result = IEC104_NET_WOULD_BLOCK;
|
||||
out.native_error = code;
|
||||
return out;
|
||||
}
|
||||
out.native_error = code;
|
||||
return out;
|
||||
}
|
||||
|
||||
IEC104_NetResult_t IEC104_Net_Wait(
|
||||
IEC104_NetSocket_t listener, IEC104_NetSocket_t client, uint32_t interest,
|
||||
uint32_t timeout_ms, uint32_t *ready_events, int *native_error)
|
||||
{
|
||||
slot_t *listen_slot;
|
||||
slot_t *client_slot;
|
||||
net_sock_t *sock;
|
||||
uint32_t ready = 0U;
|
||||
|
||||
(void)timeout_ms;
|
||||
if (net_ctx_is_owner_task() == 0U) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
if (ready_events == NULL || (interest & ~(IEC104_NET_EVENT_ACCEPT |
|
||||
IEC104_NET_EVENT_READ | IEC104_NET_EVENT_WRITE)) != 0U) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
*ready_events = 0U;
|
||||
if ((interest & IEC104_NET_EVENT_ACCEPT) != 0U) {
|
||||
listen_slot = find_role(listener, SLOT_LISTEN);
|
||||
/* 会话在役时不报 ACCEPT 就绪:net_listener_armed 对 ESTABLISHED 恒返 1
|
||||
* (net_socket.c:1543-1545,单 fd 模型下监听 fd 已转数据通道),若不挡,
|
||||
* 库 Wait_For_Events(:1992) 每轮收到假 ACCEPT → Process(:1897) 每轮
|
||||
* accept_pending=1 → 每轮再调 Accept。Accept 侧虽已有一次性闸,
|
||||
* 但这里挡掉才能让"无接入需求"这一事实如实上报。 */
|
||||
if (listen_slot != NULL && client_slot_find_any() == NULL &&
|
||||
net_listener_armed(listen_slot->fd) != 0) {
|
||||
ready |= IEC104_NET_EVENT_ACCEPT;
|
||||
}
|
||||
}
|
||||
if ((interest & (IEC104_NET_EVENT_READ | IEC104_NET_EVENT_WRITE)) != 0U) {
|
||||
client_slot = find_client(client);
|
||||
sock = (client_slot != NULL) ? net_get_sock(client_slot->fd) : NULL;
|
||||
if (sock != NULL) {
|
||||
if ((interest & IEC104_NET_EVENT_READ) != 0U &&
|
||||
(net_can_read(client_slot->fd) != 0 || client_slot->role == SLOT_CLIENT_EOF)) {
|
||||
ready |= IEC104_NET_EVENT_READ;
|
||||
}
|
||||
/* WRITE 就绪:net 层没有 net_can_write() 公开函数,沿用 net_select.c 的
|
||||
* 同源判据直读公开结构 net_sock_t.send_ready(send_ready 为 1 表示芯片
|
||||
* 发送 FIFO 可再写一块)。这是已知耦合:字段改名/搬迁需同步本处。 */
|
||||
if ((interest & IEC104_NET_EVENT_WRITE) != 0U && sock->send_ready != 0U) {
|
||||
ready |= IEC104_NET_EVENT_WRITE;
|
||||
}
|
||||
}
|
||||
}
|
||||
*ready_events = ready;
|
||||
/* 纯查询:sleep 责任在 netTask 主循环;timeout 0 / UINT32_MAX alike 立即返回。
|
||||
* 库的 Wait_For_Events 用 Now_Ms 自行计算 timer_expired,不依赖本函数阻塞。 */
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
|
||||
/* 按句柄值找槽(不判 role、不判代次——Close 需要先拿到槽再由判据分流)。
|
||||
* 两句柄模型下 listen 与 client 各有独立 handle,这里只做值匹配。 */
|
||||
static slot_t *slot_by_handle(uintptr_t handle)
|
||||
{
|
||||
uint32_t i;
|
||||
for (i = 0U; i < IEC104_MCU_MAP_SIZE; ++i) {
|
||||
if (s_slots[i].handle == handle) {
|
||||
return &s_slots[i];
|
||||
}
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
IEC104_NetResult_t IEC104_Net_Close(
|
||||
IEC104_NetSocket_t socket_handle, int *native_error)
|
||||
{
|
||||
slot_t *slot;
|
||||
|
||||
if (socket_handle == IEC104_NET_INVALID_SOCKET || socket_handle == 0U) {
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
if (net_ctx_is_owner_task() == 0U) {
|
||||
return result(IEC104_NET_ERROR, NET_ERR_INVAL, native_error);
|
||||
}
|
||||
slot = slot_by_handle(socket_handle);
|
||||
/* 陈旧/代次不匹配的 Close:幂等 OK,绝不触碰硬件。 */
|
||||
if (slot == NULL || slot->role == SLOT_FREE || net_get_generation() != slot->net_gen) {
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
if (slot->role == SLOT_CLIENT || slot->role == SLOT_CLIENT_EOF) {
|
||||
/* CLIENT 分支:只拆本客户端会话、清 CLIENT 槽,监听槽的 handle/fd/
|
||||
* net_gen/role 一概不动(库侧 listen_socket 是固定值,必须始终有效)。
|
||||
* 本分支内不存在关闭监听 fd 的任何调用路径。 */
|
||||
client_slot_drop(slot);
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
/* LISTEN 分支:仅库 TcpServer_Close / Init 失败清理会走到这里。
|
||||
* 真关监听 fd 并清整个槽(若尚有客户端槽,先按 CLIENT 语义拆掉,
|
||||
* 避免监听关了却留下无主的 client 槽)。 */
|
||||
{
|
||||
slot_t *client_slot = client_slot_find_any();
|
||||
if (client_slot != NULL) {
|
||||
client_slot_drop(client_slot);
|
||||
}
|
||||
{
|
||||
net_sock_t *sock = net_get_sock(slot->fd);
|
||||
if (sock != NULL) {
|
||||
(void)net_close_sock(sock);
|
||||
}
|
||||
}
|
||||
}
|
||||
memset(slot, 0, sizeof(*slot));
|
||||
return result(IEC104_NET_OK, 0, native_error);
|
||||
}
|
||||
|
||||
uint64_t IEC104_Net_Now_Ms(void)
|
||||
{
|
||||
return net_mono_now_ms();
|
||||
}
|
||||
|
||||
/* 函数功能:导出后端只读统计(当前只有接收字节数)。
|
||||
* 参数:rx_bytes 出参,接收 Recv 成功时的 transferred 累加值(饱和 0xFFFFFFF0);可传 NULL。
|
||||
* 返回值:无。
|
||||
*
|
||||
* apdu_tx / tx_fail 的帧级计数在 iec104_core_status_t 中,不从 Send 调用推断。 */
|
||||
void iec104_net_mcu_stats(uint32_t *rx_bytes)
|
||||
{
|
||||
if (rx_bytes != NULL) {
|
||||
*rx_bytes = s_rx_bytes;
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,149 @@
|
||||
/* 模块名称:IEC 60870-5-104 板端 Net 后端附加导出 */
|
||||
/*
|
||||
* IEC104_Net.h 的全部 ABI 由 iec104_net_mcu.c 实现,本头只导出本后端特有的
|
||||
* 只读统计入口。严禁从这里暴露 net_* 或 CH395F 细节给上层。
|
||||
*/
|
||||
#ifndef IEC104_NET_MCU_H
|
||||
#define IEC104_NET_MCU_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#include "IEC104_Net.h"
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/*
|
||||
* 功能:读取本后端累计收到的 TCP 字节数。
|
||||
* 入口参数:rx_bytes - 必填输出,写入后饱和于 0xFFFFFFF0。
|
||||
* 说明:只在 Recv 返回 OK 时按 transferred 累加;跨 TCP 重连不清零。
|
||||
* 帧级计数(apdu_tx / tx_fail)在 iec104_core_status_t 中,不从 Send 调用推断。
|
||||
* 句柄/代次不变量:后端槽的有效性只由 slot->net_gen == net_get_generation() 判定;
|
||||
* net_stack_bring_up 复位芯片并清空 net 层控制块后旧句柄一律失效,后端绝不
|
||||
* 向跨代次的 fd 发任何硬件操作(含 net_close_sock)。句柄值单调递增、永不
|
||||
* 复用(不是用 32 位 gen 编码身份),保证是"单调不复用"而非句柄内嵌校验。
|
||||
* 平台偏离:CH395F 无 setsockopt/TCP_NODELAY 配置面,视同链路恒无 Nagle 延迟;
|
||||
* Accept 不以设置 NODELAY 为 OK 条件,也不因无法设置而返回 RETRY。
|
||||
*/
|
||||
void iec104_net_mcu_stats(uint32_t *rx_bytes);
|
||||
|
||||
/* ================================================================
|
||||
* 平台 Net 后端 ABI 的复述声明(本文件即 iec104_net_mcu.c 的配对头)
|
||||
*
|
||||
* 这 11 个名字**不是本项目起的**:它们由 vendor 的 `IEC104_Net.h`(第 73~200 行)
|
||||
* 以 extern 钉死,`iec104_net_mcu.c` 只是该 ABI 在 CH395F/net_* 上的一个实现
|
||||
* (与 Windows 实现 `IEC104_Net_Windows.c` 平级)。把它们在配对头里复述一遍的
|
||||
* 作用是让"这个 .c 导出的每个非 static 符号都在头里有声明"这条规则(2.2)成立,
|
||||
* 而不是重新定义契约——契约的唯一出处仍是 `IEC104_Net.h` 的文档注释。
|
||||
*
|
||||
* 为什么这里 include 上游头而不是照抄 typedef:句柄/结果码/peer 结构体都是上游
|
||||
* 类型,照抄会与上游漂移;include 一次由编译器保证逐字一致。上层仍只从
|
||||
* iec104_net_mcu.h 取统计入口,不会因此看到 net_* 或 CH395F 细节。
|
||||
* ================================================================ */
|
||||
|
||||
/*
|
||||
* 功能:平台网络后端的运行期起点(每个运行期成功一次,须与 Cleanup 严格配对)。
|
||||
* 入口参数:native_error - 可选输出,失败时写入平台诊断码。
|
||||
* 返 回 值:OK 成功;ERROR 参数或环境无效。
|
||||
* 说明:只清后端句柄映射表,不向跨代次的旧 fd 发任何硬件操作(不变量见 .c 文件头)。
|
||||
*/
|
||||
extern IEC104_NetResult_t IEC104_Net_Init(int *native_error);
|
||||
|
||||
/*
|
||||
* 功能:结束本运行期,不关闭任何 socket(由 TcpServer 先 Close 自己持有的句柄)。
|
||||
* 入口参数:无。
|
||||
* 返 回 值:无。
|
||||
*/
|
||||
extern void IEC104_Net_Cleanup(void);
|
||||
|
||||
/*
|
||||
* 功能:返回平台"无效参数"的错误码(供上层把平台码归一化)。
|
||||
* 入口参数:无。
|
||||
* 返 回 值:平台无效参数错误码。
|
||||
*/
|
||||
extern int IEC104_Net_Invalid_Argument_Error(void);
|
||||
|
||||
/*
|
||||
* 功能:创建非阻塞 IPv4 监听句柄(只接受数字地址,不解析域名)。
|
||||
* 入口参数:bind_address 绑定地址;port 端口(0 = 由系统分配);
|
||||
* listener/bound_port 必填输出;native_error 可选输出。
|
||||
* 返 回 值:OK 交付句柄与实得端口;ERROR 失败且两个输出置无效值。
|
||||
* 说明:失败时回收本次创建的 socket,不关闭调用方先前持有的句柄。
|
||||
*/
|
||||
extern IEC104_NetResult_t IEC104_Net_Listen(
|
||||
const char *bind_address, uint16_t port, IEC104_NetSocket_t *listener,
|
||||
uint16_t *bound_port, int *native_error);
|
||||
|
||||
/*
|
||||
* 功能:从非阻塞监听句柄接入至多一个客户端,不在内部循环 accept。
|
||||
* 入口参数:listener 监听句柄;client/peer 必填输出;native_error 可选输出。
|
||||
* 返 回 值:OK 接入成功;WOULD_BLOCK 暂无待接入连接;RETRY 本次被中断或
|
||||
* 新客户端设置失败;RETRY_LATER 接入资源暂缺;ERROR 参数或其它失败。
|
||||
* 说明:单 fd 模型下第 2 次调用必须返回 WOULD_BLOCK(见 .c 文件头"一次性闸")。
|
||||
*/
|
||||
extern IEC104_NetResult_t IEC104_Net_Accept(
|
||||
IEC104_NetSocket_t listener, IEC104_NetSocket_t *client,
|
||||
IEC104_NetPeer_t *peer, int *native_error);
|
||||
|
||||
/*
|
||||
* 功能:对已接入的非阻塞客户端执行至多一次同步 recv。
|
||||
* 入口参数:socket_handle 客户端句柄;data 可写缓冲区;capacity 容量(须 > 0)。
|
||||
* 返 回 值:OK/EOF/WOULD_BLOCK/RETRY/ERROR;非 OK 时 transferred 恒为 0。
|
||||
* 说明:TCP 是字节流,一次接收不对应一个完整报文,拆帧由上层负责;
|
||||
* EOF 不自动关闭句柄,也不设置整帧错误。
|
||||
*/
|
||||
extern IEC104_NetIoResult_t IEC104_Net_Recv(
|
||||
IEC104_NetSocket_t socket_handle, void *data, size_t capacity);
|
||||
|
||||
/*
|
||||
* 功能:只读取得当前内核接收队列的字节数,不等待、不消费输入。
|
||||
* 入口参数:socket_handle 句柄;available 必填输出;native_error 可选输出。
|
||||
* 返 回 值:OK 时写入可用字节数;ERROR 失败并保留平台诊断。
|
||||
* 说明:用于给跨调度轮次的续收设定有限边界,不是完整 APDU 数,也不表示连接仍存活。
|
||||
*/
|
||||
extern IEC104_NetResult_t IEC104_Net_Pending_Input(
|
||||
IEC104_NetSocket_t socket_handle, uint32_t *available, int *native_error);
|
||||
|
||||
/*
|
||||
* 功能:对已接入的非阻塞客户端执行至多一次同步 send。
|
||||
* 入口参数:socket_handle 客户端句柄;data 待发送数据;length 长度(须 > 0)。
|
||||
* 返 回 值:OK 时 transferred 为本次被接受的字节数(可小于 length 或为 0);
|
||||
* WOULD_BLOCK/RETRY/ERROR 其余情况;本接口不返回 EOF。
|
||||
* 说明:只按 transferred 推进发送位置;返回后不再借用 data。
|
||||
*/
|
||||
extern IEC104_NetIoResult_t IEC104_Net_Send(
|
||||
IEC104_NetSocket_t socket_handle, const void *data, size_t length);
|
||||
|
||||
/*
|
||||
* 功能:等待本轮关注的监听/客户端事件;interest 为 0 时只作有限定时等待。
|
||||
* 入口参数:listener/client 按 interest 需要有效;interest 为事件位组合;
|
||||
* timeout_ms 等待时长;ready_events 必填输出;native_error 可选输出。
|
||||
* 返 回 值:OK 时就绪位有效;RETRY 被中断;ERROR 参数或等待失败。
|
||||
* 说明:最多调用一次平台等待,不无限重试;就绪后实际 I/O 仍可能暂不可读写。
|
||||
* ACCEPT 就绪必须同时满足"无在役会话",否则库会每轮重复 Accept。
|
||||
*/
|
||||
extern IEC104_NetResult_t IEC104_Net_Wait(
|
||||
IEC104_NetSocket_t listener, IEC104_NetSocket_t client, uint32_t interest,
|
||||
uint32_t timeout_ms, uint32_t *ready_events, int *native_error);
|
||||
|
||||
/*
|
||||
* 功能:关闭一个监听或客户端句柄,不调用 Cleanup 或业务回调。
|
||||
* 入口参数:socket_handle 要关闭的句柄(INVALID_SOCKET 视为已关闭)。
|
||||
* 返 回 值:OK 关闭成功或传入无效哨兵;ERROR 关闭失败。
|
||||
* 说明:句柄按值传入,调用方须自行把保存的句柄置为 INVALID_SOCKET。
|
||||
*/
|
||||
extern IEC104_NetResult_t IEC104_Net_Close(
|
||||
IEC104_NetSocket_t socket_handle, int *native_error);
|
||||
|
||||
/*
|
||||
* 功能:读取平台单调时钟(供超时与收发期限计算)。
|
||||
* 入口参数:无。
|
||||
* 返 回 值:64 位单调毫秒计数,不是 UTC 时间戳。
|
||||
*/
|
||||
extern uint64_t IEC104_Net_Now_Ms(void);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
#endif /* IEC104_NET_MCU_H */
|
||||
@@ -1,682 +0,0 @@
|
||||
/*
|
||||
* 模块名称:IEC 60870-5-104 点表与数据源适配(实现)
|
||||
* 模块功能:实现 iec104_pts.h——YC/YX/YK/定值点表(ROM)、板端默认源
|
||||
* (**测频与遥测快照**(104 改读快照)/ prot_elm / prot_set)、COV 比对(遥信变位 +
|
||||
* 遥测死区 2 点确认 + 品质变化)。点表口径见 iec104_pts.h 文件头与
|
||||
* 设计文档 §3。
|
||||
* 线程约定:init/bind 建服务前;其余仅 104 服务任务上下文(快照非原子)。
|
||||
* 创建日期:2026-10-12(B4)
|
||||
* 修改记录:
|
||||
* 2026-10-25 DTU 项目组 下游常数按工程量重定(「数据可信」):YC 死区由拟定码值域重定为
|
||||
* 二次值工程量域(额定 0.5 % 规则),判据依据见
|
||||
* k_yc 表头注释;数值随 104 改读快照迁运行参数,本表将退化为
|
||||
* ROM 默认载体。
|
||||
* 2026-10-25 DTU 项目组 104 改读快照与频率点绑定(「数据可信」,道D):YC 板端源改读
|
||||
* 测频与遥测快照(App/algo/meas.h,meas_get 无锁双区);
|
||||
* 削顶五路由快照品质 CLIPPED 驱动线上 IV(不再绑死 -1,
|
||||
* V0.2 消除双转换器无共同采样触发后零改动自动启用);0x401d 绑频率源(频率点绑定);
|
||||
* 死区改运行时副本 + set/get 入口;COV 遥测腿 = 死区
|
||||
* 连续 2 点确认(板端按快照 seq 去重)+ 品质翻转即报。
|
||||
* 单测 = test/host/iec104 TC-IEC104-025~028。
|
||||
* 运行参数段 2026-10-25 DTU 项目组 死区真源收编 App/algo/run_par.c(本层 s_yc_db
|
||||
* 副本删除,set/get 转转发壳,壳保留清确认计数语义);
|
||||
* 定值读写路由 = run_par 表先、prot_set 后(0x8020~
|
||||
* 0x8058 运行参数段 C_RD/C_SE,系数覆盖直通 adc_cal)。
|
||||
* 2026-10-26 DTU 项目组 道G task-8「UI 补齐」第 5 项非 UI 前置:新增
|
||||
* [comm] 通讯参数段(ca/port)初版落本文件尾部;
|
||||
* s_src_yk_exec() 等遥控/记录投递路径零改动。
|
||||
* 2026-10-26 DTU 项目组 同日晚纠偏:[comm] 实现整体迁出至配对模块
|
||||
* iec104_comm.c(coding-standard CODE-RULE-17 (2.2)
|
||||
* 按文件名配对判定,本文件的公开符号必须声明于
|
||||
* iec104_pts.h——[comm] 不属点表,拆出正解;契约
|
||||
* = iec104_comm.h,本文件不再引用 cfg_file)。
|
||||
*/
|
||||
#include "iec104_pts.h"
|
||||
|
||||
#include <string.h>
|
||||
|
||||
#include "iec104_asdu.h" /* QDS/DIQ 品质位常量 */
|
||||
#include "meas.h" /* 板端源:遥测 = 测频与遥测快照(104 改读快照;品质域位同源) */
|
||||
#include "run_par.h" /* 运行参数段:死区真源 + 104 读写路由 */
|
||||
#include "prot_elm.h" /* 板端源:遥信 = 元件状态 */
|
||||
#include "prot_set.h" /* 板端源:定值 + 闭锁 */
|
||||
#include "sys_log.h" /* task-10:遥控记录(SYSLOG_YK)/ 操作记录(SYSLOG_OPER) */
|
||||
#include "adc_input.h" /* adc_semantic_t(phasor 实例按语义绑定) */
|
||||
|
||||
/* ---------------- YC 表(§1.5 点号 4011+;死区列 = ROM 默认值) ------------ */
|
||||
/* 源类型(「数据可信」频率点绑定:YC 表加 src 类型区分相量/频率) */
|
||||
#define PTS_SRC_MEAS 0u /* 全周傅氏相量快照槽 sem(电气量,yc/qds 直读) */
|
||||
#define PTS_SRC_FREQ 1u /* 快照频率(freq_valid 门 → IV) */
|
||||
|
||||
typedef struct {
|
||||
uint32_t ioa;
|
||||
int8_t sem; /* 快照 yc 槽 = 语义通道(-1 = 非测量量点,当前仅频率) */
|
||||
float db_default; /* 死区工厂默认(生效真源 = run_par [run_par] 段 = 运行参数段真源) */
|
||||
uint8_t src; /* PTS_SRC_* 源类型 */
|
||||
} pts_yc_def_t;
|
||||
|
||||
/* 死区规则 = 额定二次值的 0.5 %(docs/算法/采集与算法层设计说明.md §13.7 表第 2 行建议规则,随下游常数按工程量重定采纳;
|
||||
* 额定基准 100 V / 1 A 与 App/algo/prot_set.c 头部同源,勿在此另立口径):
|
||||
* 电压类 0.5 % × 100 V = 0.5 V 电流类 0.5 % × 1 A = 0.005 A
|
||||
* 频率点不适用"额定百分比"(额定附近 0.5 Hz 与旧值同量级,维持 0.5 并随
|
||||
* 运行参数段可调)。自 104 改读快照起本表**只作工厂默认载体**:生效死区 =
|
||||
* App/algo/run_par.c 的 [run_par] 引擎副本(运行参数段真源收编,本层不再存副本);削顶五路不再 sem=-1 绑死,而是绑快照槽、由品质 CLIPPED
|
||||
* 驱动线上 IV——V0.2 削顶消失后点位零改动自动启用(口径见
|
||||
* docs/算法/采集与算法层设计说明.md §13.3 三态可用性表)。
|
||||
* ⚠ 过渡期(eng=0 引脚电压域,两点标定完成前):上送值本身非二次值,死区
|
||||
* 数字按本域偏保守(迟报不漏报);标定落地后复核(docs/算法/采集与算法层设计说明.md §13.7 表
|
||||
* 第 2 行)。判定 = 死区连续 2 点确认(104 改读快照),见 iec104_pts.h COV 说明。 */
|
||||
static const pts_yc_def_t k_yc[] = {
|
||||
{ 0x4011u, (int8_t)ADC_SEM_UA, 0.5f, PTS_SRC_MEAS }, /* 1Ua:0.5 % × 100 V */
|
||||
{ 0x4012u, (int8_t)ADC_SEM_UB, 0.5f, PTS_SRC_MEAS }, /* 1Ub:削顶 → 品质驱动 IV */
|
||||
{ 0x4013u, (int8_t)ADC_SEM_UC, 0.5f, PTS_SRC_MEAS }, /* 1Uc:同上 */
|
||||
{ 0x4014u, (int8_t)ADC_SEM_UN, 0.5f, PTS_SRC_MEAS }, /* 1U0(外部零序专用通道) */
|
||||
{ 0x4015u, (int8_t)ADC_SEM_IA, 0.005f, PTS_SRC_MEAS }, /* 1Ia:0.5 % × 1 A */
|
||||
{ 0x4016u, (int8_t)ADC_SEM_IB, 0.005f, PTS_SRC_MEAS }, /* 1Ib:削顶 → 品质驱动 IV */
|
||||
{ 0x4017u, (int8_t)ADC_SEM_IC, 0.005f, PTS_SRC_MEAS }, /* 1Ic:同上 */
|
||||
{ 0x4018u, (int8_t)ADC_SEM_IN, 0.005f, PTS_SRC_MEAS }, /* 1I0:同上 */
|
||||
{ 0x401Du, -1, 0.5f, PTS_SRC_FREQ }, /* 1f:频率点绑定——绑频率源,
|
||||
* freq_valid=0 → IV */
|
||||
};
|
||||
#define YC_N ((uint8_t)(sizeof(k_yc) / sizeof(k_yc[0])))
|
||||
|
||||
/* ===== 遥测 COV 运行时状态(104 改读快照;仅 iec104Task 上下文访问,无并发) =====
|
||||
* 判据链:新测量点 → |v − 上次上送值| > 死区?→ 连续 2 点确认 → 置变化位。
|
||||
* 基准 = **上次上送值**(非上次读值——否则慢漂移永不出死区,参考系统同款);
|
||||
* 品质(线上 qds)翻转 = 事件:不参与 2 点计数、当拍直报。 */
|
||||
static float s_yc_rep[YC_N]; /* 上次上送值(建线/确认上送时更新) */
|
||||
static uint8_t s_yc_repq[YC_N]; /* 上次上送的线上 qds */
|
||||
static uint8_t s_yc_cnf[YC_N]; /* 越死区连续计数(1 = 待确认;2 = 确认) */
|
||||
static uint32_t s_yc_seq; /* COV 已消费到的快照 seq(板端源测点去重) */
|
||||
static uint8_t s_yc_seqmode; /* 1 = 板端默认源(测点 = meas 换帧) */
|
||||
|
||||
/* ---------------- YX 表(IOA = 1..33;双点 = 开关位置类) ------------------ */
|
||||
#define YX_N 33u
|
||||
#define YX_DP_N 4u /* idx 0..3 = 双点(开关位置,V0.1 无硬件 → IV) */
|
||||
|
||||
/* 有效位图:YX15~18(idx14~17)+ YX23(idx22)+ YX31(idx30) */
|
||||
#define YX_VALID_MASK (((1uLL << 14u) | (1uLL << 15u) | (1uLL << 16u) \
|
||||
| (1uLL << 17u) | (1uLL << 22u) | (1uLL << 30u)))
|
||||
|
||||
/* ---------------- 数据源(默认 = 板端;bind_src 可整体替换) -------------- */
|
||||
static int s_src_yc_read_ex(uint8_t idx, float *out, uint16_t *qds);
|
||||
static uint64_t s_src_yx_bits(void);
|
||||
static uint64_t s_src_yx_valid(void);
|
||||
static int s_src_yk_exec(uint32_t ioa, uint8_t dpc, uint8_t select);
|
||||
static int s_src_set_read(uint32_t addr, float *out);
|
||||
static int s_src_set_write(uint32_t addr, float v, uint8_t select);
|
||||
|
||||
/* 板端默认源:遥测走**带品质**的 ex 通道(legacy yc_read 槽置 NULL——
|
||||
* s_yc_point 优先 ex;注入源两种槽位均可,见 iec104_pts.h) */
|
||||
static const iec104_pts_src_t k_default_src = {
|
||||
NULL, s_src_yx_bits, s_src_yx_valid,
|
||||
s_src_yk_exec, s_src_set_read, s_src_set_write, s_src_yc_read_ex
|
||||
};
|
||||
static const iec104_pts_src_t *s_src;
|
||||
|
||||
/* ---------------- COV 快照(遥信侧;遥测侧状态见上方 s_yc_* 块) --------- */
|
||||
static uint16_t s_yc_have; /* bit i = 已建立上送基线 */
|
||||
static uint64_t s_yx_last;
|
||||
static uint8_t s_yx_snap_ok;
|
||||
|
||||
/* ============================ 公开接口 ================================== */
|
||||
|
||||
/*
|
||||
* 函数功能:初始化点表模块(死区装 ROM 默认、清 COV/快照状态、恢复默认源)
|
||||
* 限定条件:内核启动前或 104 服务启动前,调一次
|
||||
* 函数说明:104 改读快照起不再扫 phasor 实例(数据源 = 快照,槽位 = 语义通道,编译期
|
||||
* 直接可定);重复调用 = 全状态复位(单测 reset 依赖此语义)。
|
||||
*/
|
||||
void iec104_pts_init(void) {
|
||||
/* 死区不在本层复位——真源 = run_par(cfg 引擎副本),复位入口唯一
|
||||
* run_par_init();本函数只复位 COV 状态(单测 reset 依赖此语义) */
|
||||
(void)memset(s_yc_rep, 0, sizeof(s_yc_rep));
|
||||
(void)memset(s_yc_repq, 0, sizeof(s_yc_repq));
|
||||
(void)memset(s_yc_cnf, 0, sizeof(s_yc_cnf));
|
||||
s_yc_have = 0u;
|
||||
s_yc_seq = 0u;
|
||||
s_yc_seqmode = 1u;
|
||||
s_src = &k_default_src;
|
||||
s_yx_snap_ok = 0u;
|
||||
s_yx_last = 0u;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:替换数据源(NULL = 恢复板端默认源;单测注入假源)
|
||||
* 函数说明:注入源同时把 COV 测点口径切为**每次调用一测点**(假源无快照节拍,
|
||||
* 步进由调用方控制);默认源 = 测点按 meas 换帧(seq 去重)。换源
|
||||
* 不重建基线(基线状态统一由 init 复位,防跨源半截确认序列)。
|
||||
*/
|
||||
void iec104_pts_bind_src(const iec104_pts_src_t *src) {
|
||||
if (src != NULL) {
|
||||
s_src = src;
|
||||
s_yc_seqmode = 0u;
|
||||
} else {
|
||||
s_src = &k_default_src;
|
||||
s_yc_seqmode = 1u;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:遥测点数
|
||||
*/
|
||||
uint8_t iec104_pts_yc_count(void) {
|
||||
return YC_N;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:遥测点 IOA(按下标;越界 → 0)
|
||||
*/
|
||||
uint32_t iec104_pts_yc_ioa(uint8_t idx) {
|
||||
return (idx < YC_N) ? k_yc[idx].ioa : 0u;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:品质域位映射(uint16 meas 域 → uint8 线上 QDS,104 改读快照)
|
||||
* 入口参数:q16 - 源侧品质(低字节与线上同值;高字节为 MEAS_QDS_CLIPPED 域内位)
|
||||
* 返 回 值:线上 QDS 字节 uint8_t
|
||||
* 函数说明:CLIPPED(硬件削顶,104 无对应位)映射为 IV——「削顶通道 104 恒
|
||||
* IV」口径(docs/算法/采集与算法层设计说明.md §13.3 三态可用性表)
|
||||
* 改由快照品质驱动,不再靠点表绑死 -1;OV/NT/IV 透传,其余高位丢弃。
|
||||
*/
|
||||
static uint8_t s_q_map(uint16_t q16) {
|
||||
uint8_t w = (uint8_t)(q16 & (uint16_t)(IEC104_QDS_OV | IEC104_QDS_NT
|
||||
| IEC104_QDS_IV));
|
||||
|
||||
if ((q16 & (uint16_t)MEAS_QDS_CLIPPED) != 0u) {
|
||||
w |= (uint8_t)IEC104_QDS_IV;
|
||||
}
|
||||
return w;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:读单点遥测(统一源通道 + 品质归一,yc_read 与 COV 共用唯一读径)
|
||||
* 入口参数:idx - YC 表下标 v/q - 输出(值 / 线上 qds;调用方保证非空)
|
||||
* 返 回 值:0 有效;-1 IV(含 CLIPPED 映射);-2 NT(未就绪) int
|
||||
* 函数说明:ex 源在场 → 品质由源给(板端 = 快照槽位透传);否则退 legacy
|
||||
* yc_read,品质从返回值推导(-1→IV / -2→NT / 0→无位)——旧注入源
|
||||
* 行为与 104 改读快照前**完全一致**(单测假源零改动)。判定顺序 IV > NT:
|
||||
* 开机首帧 qds=IV|NT 按无效处理(NT 只留给纯暂态)。任何无效 →
|
||||
* 信息体清零(线上口径:主站只信品质)。
|
||||
*/
|
||||
static int s_yc_point(uint8_t idx, float *v, uint8_t *q) {
|
||||
int rc;
|
||||
uint16_t q16 = 0u;
|
||||
|
||||
if ((idx >= YC_N) || (s_src == NULL)
|
||||
|| ((s_src->yc_read == NULL) && (s_src->yc_read_ex == NULL))) {
|
||||
*v = 0.0f;
|
||||
*q = (uint8_t)IEC104_QDS_IV;
|
||||
return -1;
|
||||
}
|
||||
if (s_src->yc_read_ex != NULL) {
|
||||
rc = s_src->yc_read_ex(idx, v, &q16);
|
||||
} else {
|
||||
rc = s_src->yc_read(idx, v);
|
||||
q16 = (rc == -2) ? (uint16_t)MEAS_QDS_NT
|
||||
: ((rc != 0) ? (uint16_t)MEAS_QDS_IV : 0u);
|
||||
}
|
||||
(void)rc; /* 有效性由归一后的 q 终裁(IV/NT 即无效),源返回值不直通 */
|
||||
*q = s_q_map(q16);
|
||||
rc = ((*q & (uint8_t)IEC104_QDS_IV) != 0u) ? -1
|
||||
: (((*q & (uint8_t)IEC104_QDS_NT) != 0u) ? -2 : 0);
|
||||
if (rc != 0) {
|
||||
*v = 0.0f;
|
||||
}
|
||||
return rc;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:读遥测(值 + 线上品质位;无效值清零,判据见 s_yc_point)
|
||||
* 返 回 值:0 有效 / -1 无效(NT 亦无效,品质位与 IV 区分) int
|
||||
*/
|
||||
int iec104_pts_yc_read(uint8_t idx, float *v, uint8_t *qds) {
|
||||
float val = 0.0f;
|
||||
uint8_t q = (uint8_t)IEC104_QDS_IV;
|
||||
|
||||
(void)s_yc_point(idx, &val, &q);
|
||||
if (v != NULL) {
|
||||
*v = val;
|
||||
}
|
||||
if (qds != NULL) {
|
||||
*qds = q;
|
||||
}
|
||||
return (q == 0u) ? 0 : -1;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:写死区(104 改读快照的 API 壳,转发 run_par 真源 + 清本层确认计数)
|
||||
* 入口参数:idx - YC 表下标 db - 工程量绝对死区(≥0,分档上限见 run_par)
|
||||
* 返 回 值:0 成功;-1 越界/负值/NaN/越程(run_par 副本不动) int
|
||||
* 限定条件:**iec104Task 上下文**(run_par 副本写 = 引擎对齐 int32 单字,
|
||||
* 104 执行段之外调用需自行避免与 104 写并发)
|
||||
* 函数说明:成功时清零该点待确认计数——跨死区档位不保留半截确认序列;
|
||||
* 不隐式重建基线(上送基准延续,新死区即刻生效)。落盘由 run_par
|
||||
* 脏标志 + SYS_EVT_RUN_PAR_SAVE 走 defaultTask(运行参数段持久化链)。
|
||||
*/
|
||||
int iec104_pts_yc_set_deadband(uint8_t idx, float db) {
|
||||
if (idx >= YC_N) {
|
||||
return -1;
|
||||
}
|
||||
if (run_par_deadband_set(idx, db) != 0) {
|
||||
return -1; /* 守卫(NaN/负/越程分档上限)单一实现,在 run_par */
|
||||
}
|
||||
s_yc_cnf[idx] = 0u; /* 壳语义:跨死区档位不保留半截确认序列 */
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:读当前生效死区(转发 run_par 真源)
|
||||
* 入口参数:idx - YC 表下标
|
||||
* 返 回 值:生效死区;idx 越界返 0.0 float
|
||||
* 限定条件:任意上下文(引擎副本 int32 单字读,Cortex-M 原子)
|
||||
* 函数说明:UI 回显 / 读写往返校验用;工厂默认查点表 db_default 列。
|
||||
*/
|
||||
float iec104_pts_yc_deadband(uint8_t idx) {
|
||||
return (idx < YC_N) ? run_par_deadband(idx) : 0.0f;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:遥信点数
|
||||
*/
|
||||
uint8_t iec104_pts_yx_count(void) {
|
||||
return (uint8_t)YX_N;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:遥信点 IOA(idx + 1;越界 → 0)
|
||||
*/
|
||||
uint32_t iec104_pts_yx_ioa(uint8_t idx) {
|
||||
return ((uint8_t)idx < YX_N) ? ((uint32_t)idx + 1u) : 0u;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:该遥信是否双点型(idx < 4 = 开关位置类)
|
||||
*/
|
||||
uint8_t iec104_pts_yx_is_dp(uint8_t idx) {
|
||||
return ((uint8_t)idx < YX_DP_N) ? 1u : 0u;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:读遥信(无效通道 → DIQ_IV;双点 → DPC 编码)
|
||||
*/
|
||||
void iec104_pts_yx_read(uint8_t idx, uint8_t *out) {
|
||||
uint64_t bits;
|
||||
uint64_t valid;
|
||||
uint8_t on;
|
||||
|
||||
if (out == NULL) {
|
||||
return;
|
||||
}
|
||||
if ((idx >= YX_N) || (s_src == NULL) || (s_src->yx_bits == NULL)
|
||||
|| (s_src->yx_valid == NULL)) {
|
||||
*out = IEC104_DIQ_IV;
|
||||
return;
|
||||
}
|
||||
valid = s_src->yx_valid();
|
||||
if (((valid >> idx) & 1u) == 0u) {
|
||||
*out = IEC104_DIQ_IV;
|
||||
return;
|
||||
}
|
||||
bits = s_src->yx_bits();
|
||||
on = (uint8_t)((bits >> idx) & 1u);
|
||||
if (iec104_pts_yx_is_dp(idx) != 0u) {
|
||||
*out = (on != 0u) ? (uint8_t)IEC104_DPC_ON : (uint8_t)IEC104_DPC_OFF;
|
||||
} else {
|
||||
*out = on;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:COV 快照比对(遥信 = 有效位翻转;遥测 = 死区)
|
||||
* 入口参数:cov = 输出变位位图(NULL = 只刷快照)
|
||||
*/
|
||||
void iec104_pts_cov_check(iec104_pts_cov_t *cov) {
|
||||
iec104_pts_cov_t local;
|
||||
|
||||
(void)memset(&local, 0, sizeof(local));
|
||||
|
||||
/* YX:变位 = 有效位上的位翻转(无效位不参与,避免 IV 通道抖动成"变位") */
|
||||
if ((s_src != NULL) && (s_src->yx_bits != NULL)
|
||||
&& (s_src->yx_valid != NULL)) {
|
||||
uint64_t bits = s_src->yx_bits() & s_src->yx_valid();
|
||||
|
||||
if (s_yx_snap_ok != 0u) {
|
||||
local.yx_changed = bits ^ s_yx_last;
|
||||
}
|
||||
s_yx_last = bits;
|
||||
s_yx_snap_ok = 1u;
|
||||
}
|
||||
|
||||
/* YC(104 改读快照):测点推进 = 板端源按快照换帧(100 ms poll vs 200 ms 快照,
|
||||
* 不去重则同一帧计两次 → "连续 2 点确认"退化成"连续 2 次轮询",单帧
|
||||
* 噪声即可被确认,抗噪语义失效);注入源 = 每次调用一测点。
|
||||
* 判定 = 死区连续 2 点确认 + 品质翻转直报(口径全文 → iec104_pts.h)。 */
|
||||
if ((s_src != NULL)
|
||||
&& ((s_src->yc_read != NULL) || (s_src->yc_read_ex != NULL))) {
|
||||
uint8_t step = 1u;
|
||||
|
||||
if (s_yc_seqmode != 0u) {
|
||||
uint32_t sq = meas_seq();
|
||||
|
||||
if (sq == s_yc_seq) {
|
||||
step = 0u; /* 未换帧:本 poll 不算新测量点 */
|
||||
} else {
|
||||
s_yc_seq = sq;
|
||||
}
|
||||
}
|
||||
if (step != 0u) {
|
||||
uint8_t i;
|
||||
|
||||
for (i = 0u; i < YC_N; i++) {
|
||||
float v;
|
||||
uint8_t q;
|
||||
int rc = s_yc_point(i, &v, &q);
|
||||
|
||||
if (((s_yc_have >> i) & 1u) == 0u) {
|
||||
if (rc == 0) { /* 首个有效读数只建线不上报(初值归总召) */
|
||||
s_yc_have |= (uint16_t)(1u << i);
|
||||
s_yc_rep[i] = v;
|
||||
s_yc_repq[i] = q;
|
||||
s_yc_cnf[i] = 0u;
|
||||
}
|
||||
continue;
|
||||
}
|
||||
if (q != s_yc_repq[i]) {
|
||||
/* 品质翻转 = 事件直报(含 0x401d 的 IV 进出,频率点绑定) */
|
||||
local.yc_changed |= (uint16_t)(1u << i);
|
||||
s_yc_repq[i] = q;
|
||||
s_yc_cnf[i] = 0u;
|
||||
if (rc == 0) {
|
||||
s_yc_rep[i] = v;
|
||||
}
|
||||
continue;
|
||||
}
|
||||
if (rc != 0) {
|
||||
s_yc_cnf[i] = 0u; /* 无效期间不计数(品质未变 = 状态延续) */
|
||||
continue;
|
||||
}
|
||||
{
|
||||
float d = v - s_yc_rep[i];
|
||||
|
||||
if (d < 0.0f) {
|
||||
d = -d;
|
||||
}
|
||||
if (d > run_par_deadband(i)) {
|
||||
s_yc_cnf[i]++;
|
||||
if (s_yc_cnf[i] >= 2u) { /* 连续 2 越 → 确认:报 + 移基准 */
|
||||
local.yc_changed |= (uint16_t)(1u << i);
|
||||
s_yc_rep[i] = v;
|
||||
s_yc_cnf[i] = 0u;
|
||||
}
|
||||
} else {
|
||||
s_yc_cnf[i] = 0u; /* 回摆入死区 → 撤销候选(抗噪核心) */
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (cov != NULL) {
|
||||
*cov = local;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:遥控两段式(转发数据源;select=1 选择段 / 0 执行段)
|
||||
* 返 回 值:0 接受 / -1 拒绝(调用方回 PN)
|
||||
*/
|
||||
int iec104_pts_yk_exec(uint32_t ioa, uint8_t dpc, uint8_t select) {
|
||||
if ((s_src == NULL) || (s_src->yk_exec == NULL)) {
|
||||
return -1;
|
||||
}
|
||||
return s_src->yk_exec(ioa, dpc, select);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:按通讯地址读定值(工程量浮点)
|
||||
* 返 回 值:0 / -1 未知地址
|
||||
*/
|
||||
int iec104_pts_set_read(uint32_t addr, float *out) {
|
||||
if ((s_src == NULL) || (s_src->set_read == NULL)) {
|
||||
return -1;
|
||||
}
|
||||
return s_src->set_read(addr, out);
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:按通讯地址写定值(select=1 只校验;0 执行写入)
|
||||
* 返 回 值:0 / -1 越界或未知地址
|
||||
*/
|
||||
int iec104_pts_set_write(uint32_t addr, float v, uint8_t select) {
|
||||
if ((s_src == NULL) || (s_src->set_write == NULL)) {
|
||||
return -1;
|
||||
}
|
||||
return s_src->set_write(addr, v, select);
|
||||
}
|
||||
|
||||
/* ============================ 板端默认源 ================================= */
|
||||
|
||||
/*
|
||||
* 函数功能:板端默认源 - 遥测 = 测频与遥测快照直读(「数据可信」104 改读快照与频率点绑定)
|
||||
* 入口参数:idx - YC 表下标 out/qds - 值 + uint16 域品质(MEAS_QDS_*)
|
||||
* 返 回 值:0 / -1 越界或频率未新鲜(IV)/ -2 快照从未发布(NT) int
|
||||
* 限定条件:iec104Task 上下文(meas_get 为双区无锁读,App/algo/meas.h)
|
||||
* 函数说明:**不做任何本地判断**——电气路值/品质整体透传快照槽(削顶路快照
|
||||
* 已置 CLIPPED,s_q_map 映上线 IV;开机首帧 IV|NT 由 s_yc_point 按
|
||||
* IV 处理),"新不新、能不能信"全在发布侧一处决定(遥测快照发布的设计意图,
|
||||
* 两处判断必打架)。频率路(PTS_SRC_FREQ):snap.freq_valid==0 →
|
||||
* IV(频率点绑定 DoD 原句);有效时值 = snap.freq_hz,与 freq_get() 同源。
|
||||
*/
|
||||
static int s_src_yc_read_ex(uint8_t idx, float *out, uint16_t *qds) {
|
||||
meas_snap_t snap;
|
||||
|
||||
if ((idx >= YC_N) || (out == NULL) || (qds == NULL)) {
|
||||
return -1;
|
||||
}
|
||||
if (meas_get(&snap) != 0) {
|
||||
*out = 0.0f; /* 从未发布(开机 <200 ms)= 暂态 */
|
||||
*qds = (uint16_t)(MEAS_QDS_IV | MEAS_QDS_NT);
|
||||
return -2;
|
||||
}
|
||||
if (k_yc[idx].src == (uint8_t)PTS_SRC_FREQ) {
|
||||
if (snap.freq_valid == 0u) {
|
||||
*out = 0.0f;
|
||||
*qds = (uint16_t)MEAS_QDS_IV;
|
||||
return -1;
|
||||
}
|
||||
*out = snap.freq_hz;
|
||||
*qds = 0u;
|
||||
return 0;
|
||||
}
|
||||
if (k_yc[idx].sem < 0) {
|
||||
*out = 0.0f; /* 理论不可达:现无未绑测量量点 */
|
||||
*qds = (uint16_t)MEAS_QDS_IV;
|
||||
return -1;
|
||||
}
|
||||
*out = snap.yc[(uint8_t)k_yc[idx].sem];
|
||||
*qds = snap.qds[(uint8_t)k_yc[idx].sem];
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:板端默认源 - 遥信位图(保护元件动作态 + 定值闭锁)
|
||||
*/
|
||||
static uint64_t s_src_yx_bits(void) {
|
||||
prot_elm_state_t oc1;
|
||||
prot_elm_state_t oc2;
|
||||
prot_elm_state_t oc3;
|
||||
prot_elm_state_t ol;
|
||||
prot_elm_state_t u0;
|
||||
uint64_t bits = 0u;
|
||||
|
||||
prot_elm_state(PE_OC1, &oc1);
|
||||
prot_elm_state(PE_OC2, &oc2);
|
||||
prot_elm_state(PE_OC3, &oc3);
|
||||
prot_elm_state(PE_OL, &ol);
|
||||
prot_elm_state(PE_3U0, &u0);
|
||||
if ((oc1.asserted != 0u) || (oc2.asserted != 0u) || (oc3.asserted != 0u)
|
||||
|| (u0.asserted != 0u)) {
|
||||
bits |= (1uLL << 14u); /* YX15 故障总 */
|
||||
}
|
||||
if (oc1.asserted != 0u) {
|
||||
bits |= (1uLL << 15u); /* YX16 过流 I 段 */
|
||||
}
|
||||
if (oc2.asserted != 0u) {
|
||||
bits |= (1uLL << 16u); /* YX17 过流 II 段 */
|
||||
}
|
||||
if (oc3.asserted != 0u) {
|
||||
bits |= (1uLL << 17u); /* YX18 过流 III 段 */
|
||||
}
|
||||
if (ol.asserted != 0u) {
|
||||
bits |= (1uLL << 22u); /* YX23 过载 */
|
||||
}
|
||||
if (prot_set_locked() != 0u) {
|
||||
bits |= (1uLL << 30u); /* YX31 保护闭锁 */
|
||||
}
|
||||
return bits;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:板端默认源 - 遥信有效位图(V0.1 = YX15~18/23/31)
|
||||
*/
|
||||
static uint64_t s_src_yx_valid(void) {
|
||||
return YX_VALID_MASK;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:板端默认源 - 遥控(YK11 复归 → prot_elm_request_reset;
|
||||
* YK12 全局软压板 → PS_GLOBAL_EN 两段式转真,B7)
|
||||
* 返 回 值:0 / -1 无出口硬件或未知 IOA(YK1~4/13/14 负向确认)
|
||||
* 函数说明:本回调跑在 iec104Task 上下文,**不得**直接 prot_elm_init()
|
||||
* (与 protectTask 的 eval 竞态)→ 落请求,下一拍 eval 头部消费(B5)。
|
||||
* YK12 走 prot_set_set_sealed(原子写+封存,B7);protectTask 下一拍
|
||||
* 读到压板态即复位元件并停判据(protect_task.c)。
|
||||
*/
|
||||
/* 遥控记录的文案表(task-10)。**全部 ROM 常量、零拼接**:本回调跑在
|
||||
* iec104Task,而 iec104_serv.c 的日志缓冲已经因为"深链模块"被收到 128 B,
|
||||
* 这里再 snprintf 一条"YK ioa=0x600B dpc=2 sel=0 rc=0"就是往那条链上加缓冲;
|
||||
* 记录类型由 SYSLOG_YK 这个文件本身回答,屏上话术归 UI(App/log/README.md 口径)。
|
||||
* 最长一条 20 字符 < SYSLOG_DESC_MAX(28)。 */
|
||||
#define YK_REC_YK11_SEL "YK11 select"
|
||||
#define YK_REC_YK11_EXEC "YK11 exec"
|
||||
#define YK_REC_YK12_SEL "YK12 select"
|
||||
#define YK_REC_YK12_ON "YK12 exec on"
|
||||
#define YK_REC_YK12_OFF "YK12 exec off"
|
||||
#define YK_REC_YK12_FAIL "YK12 exec fail"
|
||||
#define YK_REC_DPC_BAD "YK12 bad dpc"
|
||||
#define YK_REC_UNKNOWN "YK unknown ioa"
|
||||
|
||||
static int s_src_yk_exec(uint32_t ioa, uint8_t dpc, uint8_t select) {
|
||||
switch (ioa) {
|
||||
case 0x600Au: /* YK11 信号复归 → 元件状态复位(异步一拍) */
|
||||
(void)dpc; /* 复归与双点值无关 */
|
||||
if (select == 0u) {
|
||||
prot_elm_request_reset();
|
||||
/* 遥控记录(执行段已受理)+ 操作记录(本地/远端强制复归)。
|
||||
* 两条不是重复留痕:前者回答"主站下了什么命令、结果如何",后者
|
||||
* 回答"装置被谁改动了状态"——UI 的遥控记录页与操作记录页各读一份。
|
||||
* YK11 没有可失败的下游(request_reset 只置单字节标志),所以它
|
||||
* 只有受理态,没有 fail 分支。 */
|
||||
syslog_post_quiet(SYSLOG_YK, YK_REC_YK11_EXEC);
|
||||
syslog_post_quiet(SYSLOG_OPER, "force reset");
|
||||
} else {
|
||||
syslog_post_quiet(SYSLOG_YK, YK_REC_YK11_SEL);
|
||||
}
|
||||
return 0;
|
||||
case 0x600Bu: { /* YK12 全局软压板(PS_GLOBAL_EN)两段式 */
|
||||
int rc;
|
||||
if ((dpc != (uint8_t)IEC104_DPC_ON) && (dpc != (uint8_t)IEC104_DPC_OFF)) {
|
||||
syslog_post_quiet(SYSLOG_YK, YK_REC_DPC_BAD);
|
||||
return -1; /* 非法双点命令:选择段即拒 */
|
||||
}
|
||||
if (select != 0u) {
|
||||
syslog_post_quiet(SYSLOG_YK, YK_REC_YK12_SEL);
|
||||
return 0; /* 选择段 = 只校验 */
|
||||
}
|
||||
/* 执行段:set_sealed 自带范围校验与封存,失败 = 值被拒、RAM 未改。
|
||||
* 这里**必须接住返回值再落记录**(bsp-err:错误码不得裸丢弃;
|
||||
* 原实现是 return 直出,现在多一条记录后仍然原值返回,语义不变)。 */
|
||||
rc = prot_set_set_sealed(PS_GLOBAL_EN,
|
||||
(dpc == (uint8_t)IEC104_DPC_ON)
|
||||
? PROT_SET_Q10(1) : PROT_SET_Q10(0));
|
||||
if (rc != 0) {
|
||||
syslog_post_quiet(SYSLOG_YK, YK_REC_YK12_FAIL);
|
||||
} else {
|
||||
syslog_post_quiet(SYSLOG_YK,
|
||||
(dpc == (uint8_t)IEC104_DPC_ON) ? YK_REC_YK12_ON
|
||||
: YK_REC_YK12_OFF);
|
||||
/* 压板投退是一次真实的运维动作(保护退出/恢复服务)→ 同时进操作记录 */
|
||||
syslog_post_quiet(SYSLOG_OPER,
|
||||
(dpc == (uint8_t)IEC104_DPC_ON) ? "plate in"
|
||||
: "plate out");
|
||||
}
|
||||
return rc;
|
||||
}
|
||||
default:
|
||||
syslog_post_quiet(SYSLOG_YK, YK_REC_UNKNOWN);
|
||||
return -1; /* 其余 YK:无出口硬件/无对应能力 → 拒绝 */
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:板端默认源 - 定值读(**路由顺序 = run_par 表先、未命中落 prot_set**:
|
||||
* 0x8027~0x802A 属 prot_set 告警段,run_par 命中集为精确地址匹配、
|
||||
* 永不覆盖之;两表共存靠「先专属表、后通用扫」分流,勿反序——反序
|
||||
* 当前无冲突但失去 run_par 守卫先行留痕的意义)
|
||||
* 返 回 值:0 / -1 未知地址(本地项 comm_addr=0 不可寻址,B7 起显式排除)
|
||||
*/
|
||||
static int s_src_set_read(uint32_t addr, float *out) {
|
||||
uint32_t i;
|
||||
|
||||
if (out == NULL) {
|
||||
return -1;
|
||||
}
|
||||
if (run_par_104_read(addr, out) == 0) {
|
||||
return 0; /* 运行参数段命中 */
|
||||
}
|
||||
for (i = 0u; i < (uint32_t)PS_ID_COUNT; i++) {
|
||||
if ((g_prot_set_meta[i].comm_addr != 0u)
|
||||
&& (g_prot_set_meta[i].comm_addr == (uint16_t)addr)) {
|
||||
*out = prot_set_get_f((prot_set_id_t)i);
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
return -1;
|
||||
}
|
||||
|
||||
/*
|
||||
* 函数功能:板端默认源 - 定值写(**先 run_par 后 prot_set**,分流理由见
|
||||
* s_src_set_read 头注;prot_set 腿 = Q10 范围校验 + 执行段
|
||||
* prot_set_set_sealed 原子写+封存,B7 收口 B5 竞态窗口)
|
||||
* 返 回 值:0 / -1 越界或未知地址(本地项 comm_addr=0 不可寻址);两条落盘
|
||||
* 链独立:run_par 腿脏 → SYS_EVT_RUN_PAR_SAVE(cfg_file),
|
||||
* prot_set 腿脏 → SYS_EVT_PROT_SET_SAVE(/prot_set.bin)
|
||||
*/
|
||||
static int s_src_set_write(uint32_t addr, float v, uint8_t select) {
|
||||
uint32_t i;
|
||||
int32_t q10;
|
||||
int rp;
|
||||
|
||||
rp = run_par_104_write(addr, v, select);
|
||||
if (rp != -2) {
|
||||
return rp; /* 本段地址:0 接受 / -1 拒绝,不再下探 */
|
||||
}
|
||||
|
||||
for (i = 0u; i < (uint32_t)PS_ID_COUNT; i++) {
|
||||
const prot_set_meta_t *meta = &g_prot_set_meta[i];
|
||||
|
||||
if ((meta->comm_addr == 0u) || (meta->comm_addr != (uint16_t)addr)) {
|
||||
continue;
|
||||
}
|
||||
q10 = PROT_SET_Q10(v);
|
||||
if ((q10 < meta->min) || (q10 > meta->max)) {
|
||||
return -1; /* 越界:选择段即拒(执行段同样拒) */
|
||||
}
|
||||
if (select != 0u) {
|
||||
return 0; /* 选择段 = 只做范围校验 */
|
||||
}
|
||||
return prot_set_set_sealed((prot_set_id_t)i, q10);
|
||||
}
|
||||
return -1; /* 未知地址 */
|
||||
}
|
||||
@@ -1,130 +0,0 @@
|
||||
/*
|
||||
* 模块名称:IEC 60870-5-104 点表与数据源适配(纯逻辑 + 源注入)
|
||||
* 模块功能:104 点表(遥测 YC / 遥信 YX / 遥控 YK / 定值)的定义、读取与变化检测
|
||||
* (COV:遥信变位 + 遥测死区)。**数据源经 vtable 注入**:板端绑
|
||||
* phasor/prot_elm/prot_set 真实源;主机单测绑假源 → 协议栈全链
|
||||
* (asdu+pts+link)可离线跑(分层约束:协议解析与硬件 I/O 分离)。
|
||||
* 点表口径(docs/算法/继电保护功能复现规划.md §1.5,验收 = 省电科院点表):
|
||||
* - YC:IOA 0x4011~0x4018 + 0x401d(频率),短浮点、系数 1;数据源 =
|
||||
* 测频与遥测快照(App/algo/meas.h,「数据可信」104 改读快照与频率点绑定):电气 8 路绑快照槽,
|
||||
* 有效性由快照品质驱动——V0.1 削顶路(docs/算法/继电保护功能复现规划.md
|
||||
* §1.6)快照置 CLIPPED → 本层映射为线上 IV(V0.2 后自动启用,绑定零
|
||||
* 改动,见 docs/算法/采集与算法层设计说明.md §13.3 三态可用性表);0x401d 绑频率源,
|
||||
* freq_valid()==0 → IV;
|
||||
* - YX:IOA 1~33(§1.5 表(3));双点 = 开关位置类(YX1~4,本期无硬件 → IV),
|
||||
* 保护动作类 YX15~23 映射 prot_elm 状态,闭锁类 YX31~33 映射 prot_set;
|
||||
* - YK:IOA 0x6000+(§1.5 表(3));V0.1 无出口硬件(规划 R7)——
|
||||
* YK11 信号复归(→ prot_elm_request_reset)与 YK12 全局软压板
|
||||
* (→ PS_GLOBAL_EN 两段式转真,B7)转真执行,其余一律否定确认(COT|PN),如实回;
|
||||
* - 定值:IOA = prot_set 元数据 comm_addr(0x8820 基址 + 告警段 0x8027~0x802A;
|
||||
* comm_addr=0 本地项不可寻址),
|
||||
* 读经 C_RD、写经 C_SE_NC(选择/执行两段,执行段原子写+封存并置脏,
|
||||
* 持久化 /prot_set.bin 由 defaultTask 执行,B7);
|
||||
* - 固有参数 8001H~800AH:本期**不实现**(字符串类无法用短浮点上送),
|
||||
* 按未知 IOA(COT 14 + EVI)应答,登记为待办(设计文档)。
|
||||
* 线程约定:init/bind 内核启动前或建服务前;cov_check/read 仅 104 服务任务上下文。
|
||||
* 创建日期:2026-10-12(B4)
|
||||
* 修改记录:
|
||||
* 2026-10-25 DTU 项目组 104 改读快照与频率点绑定(「数据可信」,道D):YC 数据源 = 全周傅氏相量遥测
|
||||
* 快照(削顶路由品质驱动 IV);死区改运行时副本 +
|
||||
* set/get 入口;COV 遥测腿 = 死区 2 点确认(seq 去重)
|
||||
* + 品质变化即报;0x401d 绑频率源(freq_valid → IV)。
|
||||
* 2026-10-25 DTU 项目组 运行参数段:死区真源迁 run_par([run_par] cfg 段 +
|
||||
* 0x8020~0x8058 读写映射;本层 set/get 为转发壳)。
|
||||
*/
|
||||
#ifndef IEC104_PTS_H
|
||||
#define IEC104_PTS_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
/* ---------------- 数据源 vtable(NULL 项 = 该能力不可用 → 按无效/拒绝处理) -- */
|
||||
typedef struct {
|
||||
/* 遥测读:idx = YC 表下标;out = 工程量浮点。
|
||||
* 返回 0 有效 / -1 无效(发 IV)/ -2 数据未就绪(发 NT,如相量未满一周波) */
|
||||
int (*yc_read)(uint8_t idx, float *out);
|
||||
/* 遥信位图:bit i = YX 表下标 i 的"合/动作"态(双点按 ON 计) */
|
||||
uint64_t (*yx_bits)(void);
|
||||
/* 遥信有效位图:bit i = 1 该点有效;0 → 发 IV(无硬件/未实现) */
|
||||
uint64_t (*yx_valid)(void);
|
||||
/* 遥控:select=1 选择段 / 0 执行段(dpc 已剥 S 位)。返回 0 接受 / -1 拒绝 */
|
||||
int (*yk_exec)(uint32_t ioa, uint8_t dpc, uint8_t select);
|
||||
/* 定值读:addr = 通讯地址;返回 0 存在 / -1 未知地址 */
|
||||
int (*set_read)(uint32_t addr, float *out);
|
||||
/* 定值写:select=1 预置校验(范围)/ 0 执行写入。返回 0 / -1 越界或未知 */
|
||||
int (*set_write)(uint32_t addr, float v, uint8_t select);
|
||||
/* 遥测读(带品质,104 改读快照时追加于表尾——旧源 NULL = 走 yc_read 退路,品质由
|
||||
* 返回值推导:-1 → IV、-2 → NT、0 → 无位,行为与旧源完全一致)。
|
||||
* qds = uint16 域位(App/algo/meas.h MEAS_QDS_*:低字节 = 线上 QDS 同值,
|
||||
* 高字节 CLIPPED 由本层映射线上 IV);返回 0 / -1 IV / -2 NT */
|
||||
int (*yc_read_ex)(uint8_t idx, float *out, uint16_t *qds);
|
||||
} iec104_pts_src_t;
|
||||
|
||||
/* ---------------- 变化检测结果(cov_check 输出) ---------------- */
|
||||
typedef struct {
|
||||
uint64_t yx_changed; /* bit i = YX 下标 i 变位(相对上次快照) */
|
||||
uint16_t yc_changed; /* bit i = YC 下标 i 越过死区(相对上次快照) */
|
||||
} iec104_pts_cov_t;
|
||||
|
||||
/*
|
||||
* 函数功能:点表层初始化(清快照、绑板端默认源)
|
||||
* 限定条件:内核启动前或 104 服务启动前,调一次
|
||||
*/
|
||||
void iec104_pts_init(void);
|
||||
|
||||
/*
|
||||
* 函数功能:覆盖数据源(主机单测注假源)
|
||||
* 入口参数:src - vtable(浅拷贝,调用方保生命周期);NULL = 恢复板端默认源
|
||||
*/
|
||||
void iec104_pts_bind_src(const iec104_pts_src_t *src);
|
||||
|
||||
/* ---------------- YC ---------------- */
|
||||
uint8_t iec104_pts_yc_count(void);
|
||||
uint32_t iec104_pts_yc_ioa(uint8_t idx);
|
||||
/* 读 YC:v 有效值(无效时为 0);qds 输出线上品质位(IV/NT/OV,CLIPPED 已映射
|
||||
* 为 IV)。返回 0/无效-1(NT 亦无效,品质位区分) */
|
||||
int iec104_pts_yc_read(uint8_t idx, float *v, uint8_t *qds);
|
||||
/* 死区写(104 改读快照 API;运行参数段起 = 转发 App/algo/run_par.c 真源 + 清本层确认计数):
|
||||
* db = 工程量绝对值 ≥0(电压 50 V / 电流 1 A / 频率 5 Hz 分档上限);越界/负值/
|
||||
* NaN → -1 且真源不动;成功时清零该点待确认计数(跨档位不残留半截确认——此壳
|
||||
* 行为有单测钉住)。仅 104 服务任务上下文调用。落盘 = run_par 脏 → 事件 →
|
||||
* defaultTask(运行参数段持久化链,docs/子系统设计/IEC104上行设计说明.md §3.4)。 */
|
||||
int iec104_pts_yc_set_deadband(uint8_t idx, float db);
|
||||
/* 读当前生效死区(越界 idx 返 0) */
|
||||
float iec104_pts_yc_deadband(uint8_t idx);
|
||||
|
||||
/* ---------------- YX ---------------- */
|
||||
uint8_t iec104_pts_yx_count(void);
|
||||
uint32_t iec104_pts_yx_ioa(uint8_t idx);
|
||||
uint8_t iec104_pts_yx_is_dp(uint8_t idx); /* 1 = 双点(M_DP) */
|
||||
/* 读 YX:out = DIQ/SIQ 值(含 IV)。 */
|
||||
void iec104_pts_yx_read(uint8_t idx, uint8_t *out);
|
||||
|
||||
/* ---------------- COV(每 poll 一次) ---------------- */
|
||||
/*
|
||||
* 函数功能:读全表并与上次比对(遥信变位 + 遥测死区 2 点确认 + 品质变化),
|
||||
* 输出变化集
|
||||
* 入口参数:cov - 输出(可为 NULL = 只刷快照不取变化)
|
||||
* 函数说明:遥测判据(「数据可信」104 改读快照,对标参考系统 CalfYcMea 死区 2 点确认,
|
||||
* 短板评测口径):**连续 2 个新测量点** |v - 上次上送值| > 死区才置变化位
|
||||
* (单点尖峰不确认——噪声回摆即撤销候选);品质位(线上 qds)相对上次
|
||||
* 上送值翻转 → 当拍直接置位(不等 2 点,有效性变化必须即时可见,
|
||||
* 含 0x401d 的 IV 进出)。死区 = 运行时副本(ROM 默认 = 点表列,
|
||||
* iec104_pts_yc_set_deadband() 覆盖——运行参数段的接线点)。
|
||||
* 测量点定义:板端默认源 = **快照换帧**(meas seq 前进;100 ms poll 对
|
||||
* 200 ms 快照,同一帧重复比对会计数两次 → seq 去重是确认语义成立的
|
||||
* 前提);注入源(单测假源)= 每次调用一测点。首次读到有效值只建基线
|
||||
* 不上报(突发由总召覆盖)。
|
||||
*/
|
||||
void iec104_pts_cov_check(iec104_pts_cov_t *cov);
|
||||
|
||||
/* ---------------- 遥控 ---------------- */
|
||||
/* 遥控两段式(转发 src->yk_exec;无源 = 一律拒绝)。返回 0 接受 / -1 拒绝 */
|
||||
int iec104_pts_yk_exec(uint32_t ioa, uint8_t dpc, uint8_t select);
|
||||
|
||||
/* ---------------- 定值 ---------------- */
|
||||
/* 按通讯地址读定值(转发 src->set_read)。返回 0 / -1 未知地址 */
|
||||
int iec104_pts_set_read(uint32_t addr, float *out);
|
||||
/* 按通讯地址写定值(两段)。返回 0 / -1 */
|
||||
int iec104_pts_set_write(uint32_t addr, float v, uint8_t select);
|
||||
|
||||
#endif /* IEC104_PTS_H */
|
||||
@@ -3,15 +3,26 @@
|
||||
#include <string.h>
|
||||
#include <stdlib.h>
|
||||
#include <float.h>
|
||||
/* 430 metadata slots plus four additional banks of 88 action settings.
|
||||
* Raw binary32/uint32/uint16/Boolean bits are preserved, never stored as float. */
|
||||
/* Raw binary32/uint32/uint16/Boolean bits are preserved, never stored as float. */
|
||||
#define ACTION_COUNT 88U
|
||||
#define VALUE_SLOTS (IEC104_DTU_PARAMETER_COUNT + 4U * ACTION_COUNT)
|
||||
#define SIM_QUALITY 0x20U
|
||||
#define NO_SOURCE_QUALITY 0x80U
|
||||
/* 骨架档裁剪开关(默认未定义 = 全功能,行为逐字节不变)。
|
||||
* 定义 IEC104_SOURCE_NO_VALUE_STORE 后不分配 values/staged/dirty 三张表,
|
||||
* 参数区退化为"结构完整、恒出厂默认、只读不可固化":
|
||||
* - 读:回落到 typed 表的 initial 字面量,与 init() 写入的值完全一致;
|
||||
* - 预置(PRE/SOL)与标准参数装载:显式拒绝并计数,不静默丢弃。
|
||||
* 全功能档(模拟器/产品默认面)不受影响。 */
|
||||
#ifndef IEC104_SOURCE_NO_VALUE_STORE
|
||||
/* 槽位密集化(包 B):rank 表把"索引 -> 槽位"从循环换算改成 O(1) 查表。
|
||||
* values 只保留真实可见的槽(configured 345 + area_scoped 88 x 4 区 = 697),
|
||||
* staged/dirty 只保留可写参数(writable 264),省 1025B RAM,代价 2580B Flash。 */
|
||||
#include "iec104_source_ranks.h"
|
||||
#define VALUE_SLOTS IEC104_SOURCE_VALUE_SLOTS
|
||||
static uint32_t values[VALUE_SLOTS];
|
||||
static uint32_t staged[IEC104_DTU_PARAMETER_COUNT];
|
||||
static uint8_t dirty[(IEC104_DTU_PARAMETER_COUNT + 7U) / 8U];
|
||||
static uint32_t staged[IEC104_SOURCE_STAGE_SLOTS];
|
||||
static uint8_t dirty[IEC104_SOURCE_DIRTY_BYTES];
|
||||
#endif
|
||||
static IEC104_RemoteParameterRequest_t owner;
|
||||
static bool stage_active, stage_complete;
|
||||
static iec104_source_bindings_t bindings;
|
||||
@@ -22,29 +33,40 @@ static int8_t steps[8];
|
||||
static uint32_t bits[8];
|
||||
static float measurements[IEC104_DTU_ME_COUNT];
|
||||
static uint8_t measurement_set[IEC104_DTU_ME_COUNT];
|
||||
static IEC104_CommandPoint_t commands[IEC104_DTU_COMMAND_COUNT];
|
||||
/* 标准参数点表按 (CA,IOA) 升序借用给 IEC104_Parameter 模块。
|
||||
* 只有 common_address 是运行期值(同实例同一CA),故只在这里保留20行实测可知:
|
||||
* 整表仍是 RAM,但用 4 字节索引函数代替 120 行逐字段赋值,代码与 Flash 均更省。 */
|
||||
static IEC104_ParameterPoint_t standard_points[IEC104_DTU_STANDARD_COUNT];
|
||||
static IEC104_ParameterValue_t standard_values[IEC104_DTU_STANDARD_COUNT];
|
||||
static uint64_t clock_utc, clock_mono;
|
||||
#ifndef IEC104_SOURCE_NO_VALUE_STORE
|
||||
static iec104_source_change_t changes[17];
|
||||
#endif
|
||||
static void increment(uint32_t *value) { if (*value != UINT32_MAX) { ++*value; } }
|
||||
static uint32_t float_bits(float v) { uint32_t b; memcpy(&b, &v, 4U); return b; }
|
||||
#ifndef IEC104_SOURCE_NO_VALUE_STORE
|
||||
static float bits_float(uint32_t b) { float v; memcpy(&v, &b, 4U); return v; }
|
||||
#endif
|
||||
/* 函数功能:将区域参数索引换算为压缩RAM槽位。 */
|
||||
#ifndef IEC104_SOURCE_NO_VALUE_STORE
|
||||
static size_t slot(size_t index, uint16_t area)
|
||||
{
|
||||
size_t i, n = 0U; iec104_dtu_parameter_t p;
|
||||
if (area == 0U) { return index; }
|
||||
for (i = 0U; i < index; ++i) {
|
||||
(void)iec104_dtu_parameter(i, &p); if (p.area_scoped) { ++n; }
|
||||
}
|
||||
return IEC104_DTU_PARAMETER_COUNT + (area - 1U) * ACTION_COUNT + n;
|
||||
uint16_t r;
|
||||
if (area == 0U) { return iec104_source_value_rank[index]; }
|
||||
r = iec104_source_scope_rank[index];
|
||||
if (r == IEC104_SOURCE_STAGE_NO_RANK) { r = 0U; }
|
||||
return IEC104_SOURCE_CONFIGURED_TOTAL + (size_t)(area - 1U) * (size_t)IEC104_SOURCE_SCOPED_TOTAL + (size_t)r;
|
||||
}
|
||||
/* 裁剪档无压缩槽位表,slot() 不参与编译。 */
|
||||
#endif
|
||||
/* 函数功能:丢弃预置和事务身份,不改变已固化值。 */
|
||||
static void clear_stage(void)
|
||||
{
|
||||
stage_active = false; stage_complete = false;
|
||||
memset(dirty, 0, sizeof(dirty)); memset(&owner, 0, sizeof(owner));
|
||||
#ifndef IEC104_SOURCE_NO_VALUE_STORE
|
||||
memset(dirty, 0, sizeof(dirty));
|
||||
#endif
|
||||
memset(&owner, 0, sizeof(owner));
|
||||
}
|
||||
/* 函数功能:校验预置事务所属服务、连接和站点身份。 */
|
||||
static bool same_owner(const IEC104_RemoteParameterRequest_t *r)
|
||||
@@ -54,13 +76,29 @@ static bool same_owner(const IEC104_RemoteParameterRequest_t *r)
|
||||
owner.instance_id == r->instance_id && owner.generation == r->generation &&
|
||||
owner.station_id == r->station_id && owner.common_address == r->common_address && owner.test == r->test;
|
||||
}
|
||||
static bool is_dirty(size_t i) { return (dirty[i / 8U] & (1U << (i % 8U))) != 0U; }
|
||||
#ifndef IEC104_SOURCE_NO_VALUE_STORE
|
||||
/* 函数功能:判定参数是否处于已预置未固化状态(按 stage_rank 映射到位)。 */
|
||||
static bool is_dirty(size_t i)
|
||||
{
|
||||
uint16_t r = iec104_source_stage_rank[i];
|
||||
if (r == IEC104_SOURCE_STAGE_NO_RANK) { return false; }
|
||||
return (dirty[r >> 3] & (1U << (r & 7U))) != 0U;
|
||||
}
|
||||
/* 函数功能:把参数索引换算成 staged/dirty 的密集槽位。 */
|
||||
static size_t stage_slot(size_t i) { return (size_t)iec104_source_stage_rank[i]; }
|
||||
#endif
|
||||
/* 函数功能:判定参数是否由完整的真实源回调对负责。 */
|
||||
static bool mapped(const iec104_dtu_parameter_t *p, uint16_t area, uint16_t *id, float *scale)
|
||||
{
|
||||
return bindings.parameter_read != NULL && bindings.parameter_apply != NULL &&
|
||||
(!p->area_scoped || area == stats.current_area) && iec104_dtu_protection_mapping(p->ioa, id, scale);
|
||||
}
|
||||
/* 函数功能:从 typed 表字面量还原原始位模式(裁剪档的读回落)。 */
|
||||
static uint32_t initial_bits(const iec104_dtu_parameter_t *p)
|
||||
{
|
||||
return p->tag == 38U ? float_bits((float)strtod(p->initial, NULL)) :
|
||||
(uint32_t)strtoul(p->initial, NULL, 10);
|
||||
}
|
||||
/* 函数功能:读原始TLV位模式;真实源失败不降级为模拟值。 */
|
||||
static bool read_bits(size_t index, uint16_t area, uint32_t *out)
|
||||
{
|
||||
@@ -73,10 +111,15 @@ static bool read_bits(size_t index, uint16_t area, uint32_t *out)
|
||||
if ((p.tag == 1U && v != 0.0f && v != 1.0f) ||
|
||||
(p.tag == 45U && (v > 65535.0f || (float)(uint32_t)v != v))) { return false; }
|
||||
*out = p.tag == 38U ? float_bits(v) : (uint32_t)v;
|
||||
#ifdef IEC104_SOURCE_NO_VALUE_STORE
|
||||
} else { *out = initial_bits(&p); }
|
||||
#else
|
||||
} else { *out = values[slot(index, area)]; }
|
||||
#endif
|
||||
return true;
|
||||
}
|
||||
/* 函数功能:按原始类型校验预置值和值域。 */
|
||||
#ifndef IEC104_SOURCE_NO_VALUE_STORE
|
||||
static bool valid_bits(size_t index, uint32_t raw)
|
||||
{
|
||||
iec104_dtu_parameter_t p; double v;
|
||||
@@ -99,7 +142,7 @@ static bool candidate(uint32_t ioa, uint16_t area, float *out)
|
||||
{
|
||||
size_t i = iec104_dtu_parameter_index(ioa); uint32_t raw;
|
||||
if (i >= IEC104_DTU_PARAMETER_COUNT) { return false; }
|
||||
if (is_dirty(i)) { raw = staged[i]; } else if (!read_bits(i, area, &raw)) { return false; }
|
||||
if (is_dirty(i)) { raw = staged[stage_slot(i)]; } else if (!read_bits(i, area, &raw)) { return false; }
|
||||
*out = bits_float(raw); return *out >= 0.0f && *out <= 1000000.0f;
|
||||
}
|
||||
/* 函数功能:完整校验后原子提交真实源,再发布RAM候选。 */
|
||||
@@ -113,47 +156,55 @@ static bool commit_stage(uint16_t area)
|
||||
!candidate(0x8029U, 0U, &high) || low > high)) { return false; }
|
||||
for (i = 0U; i < IEC104_DTU_PARAMETER_COUNT; ++i) {
|
||||
if (!is_dirty(i)) { continue; }
|
||||
if (!valid_bits(i, staged[i])) { return false; }
|
||||
if (!valid_bits(i, staged[stage_slot(i)])) { return false; }
|
||||
(void)iec104_dtu_parameter(i, &p);
|
||||
if (mapped(&p, area, &id, &scale)) {
|
||||
if (n >= sizeof(changes) / sizeof(changes[0])) { return false; }
|
||||
changes[n].id = id;
|
||||
changes[n++].value = (p.tag == 38U ? bits_float(staged[i]) : (float)staged[i]) * scale;
|
||||
changes[n++].value = (p.tag == 38U ? bits_float(staged[stage_slot(i)]) : (float)staged[stage_slot(i)]) * scale;
|
||||
}
|
||||
}
|
||||
if (n != 0U && (!bindings.parameter_apply(bindings.context, changes, n, true) ||
|
||||
!bindings.parameter_apply(bindings.context, changes, n, false))) { return false; }
|
||||
for (i = 0U; i < IEC104_DTU_PARAMETER_COUNT; ++i) {
|
||||
if (is_dirty(i)) { values[slot(i, area)] = staged[i]; }
|
||||
if (is_dirty(i)) { values[slot(i, area)] = staged[stage_slot(i)]; }
|
||||
}
|
||||
increment(&stats.parameter_commits); return true;
|
||||
}
|
||||
#else
|
||||
/* 函数功能:裁剪档固化入口;无值与预置表,一律按未启用拒绝并计数。 */
|
||||
static bool commit_stage(uint16_t area)
|
||||
{
|
||||
(void)area; ++stats.parameter_rejected;
|
||||
return false;
|
||||
}
|
||||
#endif
|
||||
/* 函数功能:服务启动恢复typed表默认,观测归零且无源置IV。 */
|
||||
void iec104_source_init(void)
|
||||
{
|
||||
size_t i, a, g, m; iec104_dtu_parameter_t p; uint32_t raw;
|
||||
memset(&bindings, 0, sizeof(bindings)); memset(&stats, 0, sizeof(stats));
|
||||
memset(values, 0, sizeof(values)); memset(singles, 0, sizeof(singles));
|
||||
memset(singles, 0, sizeof(singles));
|
||||
memset(single_set, 0, sizeof(single_set)); memset(doubles, 0, sizeof(doubles));
|
||||
memset(steps, 0, sizeof(steps)); memset(bits, 0, sizeof(bits));
|
||||
memset(measurements, 0, sizeof(measurements)); memset(measurement_set, 0, sizeof(measurement_set));
|
||||
clear_stage(); clock_utc = UINT64_C(946684800000); clock_mono = 0U;
|
||||
#ifndef IEC104_SOURCE_NO_VALUE_STORE
|
||||
memset(values, 0, sizeof(values));
|
||||
for (i = 0U; i < IEC104_DTU_PARAMETER_COUNT; ++i) {
|
||||
(void)iec104_dtu_parameter(i, &p);
|
||||
if (!p.configured) { continue; }
|
||||
raw = p.tag == 38U ? float_bits((float)strtod(p.initial, NULL)) : (uint32_t)strtoul(p.initial, NULL, 10);
|
||||
raw = initial_bits(&p);
|
||||
for (a = 0U; a < IEC104_DTU_AREA_COUNT; ++a) {
|
||||
if (iec104_dtu_parameter_visible(i, (uint16_t)a)) { values[slot(i, (uint16_t)a)] = raw; }
|
||||
}
|
||||
}
|
||||
#else
|
||||
(void)i; (void)a; (void)p; (void)raw; /* 裁剪档:参数值恒为 typed 表字面量,无需填充 */
|
||||
#endif
|
||||
memset(standard_values, 0, sizeof(standard_values));
|
||||
for (i = 0U; i < IEC104_DTU_STANDARD_COUNT; ++i) {
|
||||
g = i / 30U; m = i % 30U;
|
||||
standard_points[i].ioa = (uint32_t)(0x8601U + g * 0x20U + m);
|
||||
standard_points[i].kind = g == 0U ? IEC60870_ASDU_KPA_THRESHOLD :
|
||||
(g == 1U ? IEC60870_ASDU_KPA_LOW_LIMIT :
|
||||
(g == 2U ? IEC60870_ASDU_KPA_HIGH_LIMIT : IEC60870_ASDU_KPA_SMOOTHING));
|
||||
standard_points[i].type_id = g == 3U ? 112U : (g == 0U && m >= 4U ? 110U : 111U);
|
||||
if (g == 0U) { standard_values[i].scaled = m >= 4U ? 655 : 200; }
|
||||
if (g == 1U) { standard_values[i].scaled = -10000; }
|
||||
if (g == 2U) { standard_values[i].scaled = 10000; }
|
||||
@@ -230,57 +281,102 @@ bool iec104_source_find(uint32_t ioa, iec104_source_object_t *out)
|
||||
}
|
||||
return ioa >= 0x6401U && ioa <= 0x6408U && iec104_source_counter(ioa - 0x6401U, out);
|
||||
}
|
||||
/* 函数功能:命令点表模板;65点按IOA严格升序,常量常驻Flash不占RAM。 */
|
||||
/* 点位由型号固定,生成规则见下方注记;类型位为45..51与58..64两族对照。 */
|
||||
static const IEC104_CommandPoint_t command_points[IEC104_DTU_COMMAND_COUNT] = {
|
||||
/* 19点:0x6001..0x6013,45单点/46双点交替 */
|
||||
{ UINT32_C(0x6001), UINT16_C(0x0081), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6002), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6003), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6004), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6005), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6006), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6007), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6008), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6009), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x600A), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x600B), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x600C), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x600D), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x600E), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x600F), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6010), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6011), UINT16_C(0x0102), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6012), UINT16_C(0x0081), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6013), UINT16_C(0x0081), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
/* 8点:0x6101..0x6108,47升降 */
|
||||
{ UINT32_C(0x6101), UINT16_C(0x0204), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6102), UINT16_C(0x0204), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6103), UINT16_C(0x0204), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6104), UINT16_C(0x0204), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6105), UINT16_C(0x0204), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6106), UINT16_C(0x0204), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6107), UINT16_C(0x0204), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6108), UINT16_C(0x0204), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
/* 30点:0x6201..0x621E,49标度 */
|
||||
{ UINT32_C(0x6201), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6202), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6203), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6204), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6205), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6206), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6207), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6208), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6209), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x620A), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x620B), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x620C), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x620D), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x620E), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x620F), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6210), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6211), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6212), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6213), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6214), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6215), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6216), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6217), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6218), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x6219), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x621A), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x621B), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x621C), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x621D), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
{ UINT32_C(0x621E), UINT16_C(0x0810), IEC104_COMMAND_MODE_SELECT_EXECUTE },
|
||||
/* 8点:0x6301..0x6308,51位串,仅直接执行 */
|
||||
{ UINT32_C(0x6301), UINT16_C(0x2040), IEC104_COMMAND_MODE_DIRECT },
|
||||
{ UINT32_C(0x6302), UINT16_C(0x2040), IEC104_COMMAND_MODE_DIRECT },
|
||||
{ UINT32_C(0x6303), UINT16_C(0x2040), IEC104_COMMAND_MODE_DIRECT },
|
||||
{ UINT32_C(0x6304), UINT16_C(0x2040), IEC104_COMMAND_MODE_DIRECT },
|
||||
{ UINT32_C(0x6305), UINT16_C(0x2040), IEC104_COMMAND_MODE_DIRECT },
|
||||
{ UINT32_C(0x6306), UINT16_C(0x2040), IEC104_COMMAND_MODE_DIRECT },
|
||||
{ UINT32_C(0x6307), UINT16_C(0x2040), IEC104_COMMAND_MODE_DIRECT },
|
||||
{ UINT32_C(0x6308), UINT16_C(0x2040), IEC104_COMMAND_MODE_DIRECT },
|
||||
};
|
||||
/* 函数功能:返回只读命令点表;点位模板常量常驻Flash,不再占RAM。
|
||||
* 点表不再逐点存公共地址,CA由命令模块按实例站点校验,故本表可跨CA共用。 */
|
||||
const IEC104_CommandPoint_t *iec104_source_commands(uint16_t ca, size_t *count)
|
||||
{
|
||||
size_t i; uint8_t type;
|
||||
for (i = 0U; i < 65U; ++i) {
|
||||
commands[i].common_address = ca;
|
||||
if (i < 19U) { commands[i].ioa = (uint32_t)(0x6001U + i); type = i >= 1U && i <= 16U ? 46U : 45U; }
|
||||
else if (i < 27U) { commands[i].ioa = (uint32_t)(0x6101U + i - 19U); type = 47U; }
|
||||
else if (i < 57U) { commands[i].ioa = (uint32_t)(0x6201U + i - 27U); type = 49U; }
|
||||
else { commands[i].ioa = (uint32_t)(0x6301U + i - 57U); type = 51U; }
|
||||
commands[i].type_mask = IEC104_COMMAND_TYPE_BIT(type) | IEC104_COMMAND_TYPE_BIT(type + 13U);
|
||||
commands[i].mode = type == 51U ? IEC104_COMMAND_MODE_DIRECT : IEC104_COMMAND_MODE_SELECT_EXECUTE;
|
||||
}
|
||||
if (count != NULL) { *count = 65U; } return commands;
|
||||
(void)ca;
|
||||
if (count != NULL) { *count = IEC104_DTU_COMMAND_COUNT; }
|
||||
return command_points;
|
||||
}
|
||||
/* 函数功能:改变模拟遥信并标识替代源,绝不驱动物理出口。 */
|
||||
static void set_single(uint32_t ioa, uint8_t v)
|
||||
{
|
||||
size_t i; iec104_dtu_point_t p;
|
||||
for (i = 0U; i < 59U; ++i) {
|
||||
(void)iec104_dtu_point(i, &p);
|
||||
if (p.ioa == ioa) { singles[i] = v; single_set[i] = 1U; break; }
|
||||
}
|
||||
}
|
||||
/* 函数功能:选择不动作,执行修改可观测模拟状态。 */
|
||||
/* 函数功能:骨架档拒绝一切遥控命令,绝无副作用。
|
||||
* 设计(2026-11-18 裁定的方案 B):骨架阶段没有任何物理输出接缝——数据源绑定
|
||||
* 只覆盖遥信/遥测/定值,不含遥控——此时若把命令当"已启动"回肯定确认,vendor 会
|
||||
* 依次回 COT 7 肯定确认、COT 11 返回信息、COT 10 肯定终止,主站由此认定开关真的
|
||||
* 被操作过,而设备侧只改了一个 RAM 变量。因此对全部命令点、选择与执行两段一律返
|
||||
* 回 IEC104_COMMAND_ACTION_NOT_STARTED:vendor 据此回否定确认(COT 7 + P/N=1)
|
||||
* 并结束事务,既不产生返回信息也不排 ACT_TERM,与割接前"除 YK11/YK12 外一律否定
|
||||
* 确认"的对外行为对齐。
|
||||
* 恢复真实出口时:把有出口的分支改成调用对应驱动并返回 STARTED 即可,模拟状态数组
|
||||
* (singles/doubles/steps/measurements/bits)保留未删可直接复用;当前无人置位,
|
||||
* 它们的读出恒为"零值 + IV/SB"。 */
|
||||
IEC104_CommandActionResult_t iec104_source_command(void *context, const IEC104_CommandRequest_t *r)
|
||||
{
|
||||
size_t n; uint8_t type;
|
||||
(void)context;
|
||||
if (r == NULL) { return IEC104_COMMAND_ACTION_NOT_STARTED; }
|
||||
type = r->type_id >= 58U ? (uint8_t)(r->type_id - 13U) : r->type_id;
|
||||
if (r->is_select) { return IEC104_COMMAND_ACTION_STARTED; }
|
||||
if (r->ioa >= 0x6002U && r->ioa <= 0x6011U && type == 46U && (r->state == 1U || r->state == 2U)) {
|
||||
n = r->ioa - 0x6002U; doubles[n] = r->state;
|
||||
if (n == 0U) { set_single(0x11U, r->state == 2U); set_single(0x28U, r->state == 1U); }
|
||||
} else if (type == 45U && r->ioa == 0x6001U) { set_single(9U, r->state); }
|
||||
else if (type == 45U && r->ioa == 0x6013U) { set_single(0x26U, r->state); }
|
||||
else if (type == 45U && r->ioa == 0x6012U) {
|
||||
/* Reset only the simulated latch. Never resets real protection state. */
|
||||
set_single(0x16U, 0U); increment(&stats.reset_actions);
|
||||
} else if (type == 47U && r->ioa >= 0x6101U && r->ioa <= 0x6108U) {
|
||||
if (r->state != 1U && r->state != 2U) { return IEC104_COMMAND_ACTION_NOT_STARTED; }
|
||||
n = r->ioa - 0x6101U;
|
||||
if ((r->state == 1U && steps[n] == -64) || (r->state == 2U && steps[n] == 63)) { return IEC104_COMMAND_ACTION_NOT_STARTED; }
|
||||
steps[n] = (int8_t)(steps[n] + (r->state == 2U ? 1 : -1));
|
||||
} else if (type == 49U && r->ioa >= 0x6201U && r->ioa <= 0x621eU) {
|
||||
n = r->ioa - 0x6201U;
|
||||
if (r->value.scaled < -10000 || r->value.scaled > 10000) { return IEC104_COMMAND_ACTION_NOT_STARTED; }
|
||||
measurements[n] = (float)r->value.scaled; measurement_set[n] = 1U;
|
||||
} else if (type == 51U && r->ioa >= 0x6301U && r->ioa <= 0x6308U) { bits[r->ioa - 0x6301U] = r->value.bitstring; }
|
||||
else { return IEC104_COMMAND_ACTION_NOT_STARTED; }
|
||||
increment(&stats.simulated_actions); return IEC104_COMMAND_ACTION_STARTED;
|
||||
(void)context; (void)r;
|
||||
return IEC104_COMMAND_ACTION_NOT_STARTED;
|
||||
}
|
||||
/* 函数功能:列举动作反馈IOA;容量不足不写,WAIT不重执行动作。 */
|
||||
size_t iec104_source_command_feedback(uint32_t ioa, uint32_t *out, size_t capacity)
|
||||
@@ -335,6 +431,9 @@ static IEC104_RemoteParameterActionResult_t remote_action(void *context,
|
||||
IEC104_RemoteParameterElement_t element;
|
||||
bool ok;
|
||||
(void)context;
|
||||
#ifdef IEC104_SOURCE_NO_VALUE_STORE
|
||||
(void)e; (void)i; (void)b; (void)raw; (void)p; (void)element;
|
||||
#endif
|
||||
if (r == NULL) { return IEC104_REMOTE_PARAMETER_ACTION_REJECTED; }
|
||||
if (r->operation == IEC104_REMOTE_PARAMETER_OP_CANCEL || r->operation == IEC104_REMOTE_PARAMETER_OP_DISCARD) {
|
||||
clear_stage(); return IEC104_REMOTE_PARAMETER_ACTION_APPLIED;
|
||||
@@ -355,6 +454,11 @@ static IEC104_RemoteParameterActionResult_t remote_action(void *context,
|
||||
clear_stage(); return ok ? IEC104_REMOTE_PARAMETER_ACTION_APPLIED : IEC104_REMOTE_PARAMETER_ACTION_REJECTED;
|
||||
}
|
||||
if (r->operation != IEC104_REMOTE_PARAMETER_OP_PRESET) { return IEC104_REMOTE_PARAMETER_ACTION_REJECTED; }
|
||||
#ifdef IEC104_SOURCE_NO_VALUE_STORE
|
||||
/* 裁剪档:无预置表,预置一律显式拒绝并计数(不静默丢弃)。 */
|
||||
++stats.parameter_rejected; clear_stage();
|
||||
return IEC104_REMOTE_PARAMETER_ACTION_REJECTED;
|
||||
#else
|
||||
if (r->first_frame) { clear_stage(); owner = *r; owner._data = NULL; owner._length = 0U; stage_active = true; }
|
||||
if (!same_owner(r) || owner.sn != r->sn || stage_complete) { clear_stage(); return IEC104_REMOTE_PARAMETER_ACTION_REJECTED; }
|
||||
for (e = 0U; e < r->count; ++e) {
|
||||
@@ -368,19 +472,29 @@ static IEC104_RemoteParameterActionResult_t remote_action(void *context,
|
||||
raw = 0U;
|
||||
for (b = 0U; b < element.length; ++b) { raw |= (uint32_t)element.value[b] << (8U * b); }
|
||||
if (!valid_bits(i, raw)) { clear_stage(); return IEC104_REMOTE_PARAMETER_ACTION_REJECTED; }
|
||||
staged[i] = raw; dirty[i / 8U] |= (uint8_t)(1U << (i % 8U));
|
||||
{ size_t s = stage_slot(i); staged[s] = raw; dirty[s / 8U] |= (uint8_t)(1U << (s % 8U)); }
|
||||
}
|
||||
stage_complete = !r->more_follows;
|
||||
return IEC104_REMOTE_PARAMETER_ACTION_APPLIED;
|
||||
#endif
|
||||
}
|
||||
const IEC104_RemoteParameterHandlers_t iec104_source_remote_handlers = {remote_action, remote_lookup};
|
||||
/* 函数功能:装配标准参数模块借用的稳定点表和值存储。 */
|
||||
/* 函数功能:装配标准参数模块借用的稳定点表和值存储。
|
||||
* 说明:120 行同 CA,点表按 (CA,IOA) 升序;LOAD 校验和总召编码都用 standard_points。 */
|
||||
void iec104_source_parameter_config(uint16_t ca, IEC104_ParameterConfig_t *config)
|
||||
{
|
||||
size_t i;
|
||||
size_t i, g, m;
|
||||
if (config == NULL) { return; }
|
||||
IEC104_Parameter_Config_Default(config);
|
||||
for (i = 0U; i < 120U; ++i) { standard_points[i].common_address = ca; }
|
||||
for (i = 0U; i < IEC104_DTU_STANDARD_COUNT; ++i) {
|
||||
g = i / 30U; m = i % 30U;
|
||||
standard_points[i].common_address = ca;
|
||||
standard_points[i].ioa = (uint32_t)(0x8601U + g * 0x20U + m);
|
||||
standard_points[i].kind = g == 0U ? IEC60870_ASDU_KPA_THRESHOLD :
|
||||
(g == 1U ? IEC60870_ASDU_KPA_LOW_LIMIT :
|
||||
(g == 2U ? IEC60870_ASDU_KPA_HIGH_LIMIT : IEC60870_ASDU_KPA_SMOOTHING));
|
||||
standard_points[i].type_id = g == 3U ? 112U : (g == 0U && m >= 4U ? 110U : 111U);
|
||||
}
|
||||
config->points = standard_points; config->values = standard_values; config->point_count = 120U;
|
||||
}
|
||||
/* 函数功能:校验标准参数装载;TEST不改值,周期许可由核心执行。 */
|
||||
@@ -388,12 +502,20 @@ IEC104_ParameterActionResult_t iec104_source_parameter_action(void *context, con
|
||||
{
|
||||
size_t i, m, g; bool valid = false;
|
||||
(void)context;
|
||||
#ifdef IEC104_SOURCE_NO_VALUE_STORE
|
||||
(void)i; (void)m; (void)g; (void)valid;
|
||||
#endif
|
||||
if (r == NULL || r->phase != IEC104_PARAMETER_PHASE_EXECUTE) { return IEC104_PARAMETER_ACTION_REJECTED; }
|
||||
if (r->operation != IEC104_PARAMETER_OP_LOAD) {
|
||||
/* QPA=3 selects periodic transmission; no value mutation is needed.
|
||||
* Core owns scheduling and must apply its scan enable after acceptance. */
|
||||
return r->qpa == 3U && r->ioa == 0U ? IEC104_PARAMETER_ACTION_APPLIED : IEC104_PARAMETER_ACTION_REJECTED;
|
||||
}
|
||||
#ifdef IEC104_SOURCE_NO_VALUE_STORE
|
||||
/* 裁剪档:标准参数只读,装载一律显式拒绝并计数(不静默丢弃)。 */
|
||||
++stats.parameter_rejected;
|
||||
return IEC104_PARAMETER_ACTION_REJECTED;
|
||||
#else
|
||||
i = r->point_index;
|
||||
if (i >= 120U || standard_points[i].ioa != r->ioa || standard_points[i].type_id != r->type_id) { return IEC104_PARAMETER_ACTION_UNKNOWN_IOA; }
|
||||
m = i % 30U; g = i / 30U;
|
||||
@@ -404,6 +526,7 @@ IEC104_ParameterActionResult_t iec104_source_parameter_action(void *context, con
|
||||
if (!valid) { return IEC104_PARAMETER_ACTION_REJECTED; }
|
||||
if (!r->test) { standard_values[i] = r->value; increment(&stats.parameter_commits); }
|
||||
return IEC104_PARAMETER_ACTION_APPLIED;
|
||||
#endif
|
||||
}
|
||||
/* 函数功能:设置仅设备虚拟墙钟的UTC纪元及单调基点。 */
|
||||
void iec104_source_clock_seed(uint64_t utc_ms, uint64_t mono_ms)
|
||||
|
||||
@@ -40,6 +40,10 @@ typedef struct {
|
||||
typedef struct {
|
||||
uint32_t simulated_actions, physical_do_actions, parameter_commits, clock_sets;
|
||||
uint32_t reset_actions;
|
||||
/* Counts parameter writes refused because the build has no value store
|
||||
* (IEC104_SOURCE_NO_VALUE_STORE). Always 0 in the full-feature build, where
|
||||
* refusals are ordinary protocol rejections and not tracked here. */
|
||||
uint32_t parameter_rejected;
|
||||
uint16_t current_area;
|
||||
bool synchronized;
|
||||
} iec104_source_stats_t;
|
||||
|
||||
@@ -0,0 +1,202 @@
|
||||
/* 模块名称:参数值槽 rank 映射表(生成文件,勿手改)。 */
|
||||
/* GENERATED FILE - do not edit by hand.
|
||||
* Source: App/protocol/iec60870/examples/iec104_dtu_profile.h (const profile table).
|
||||
* Generator: ci-artifacts/iec104-cutover/gen_source_ranks.py
|
||||
* Design: ci-artifacts/iec104-cutover/package-b-design.md
|
||||
* Include exactly once, from App/protocol/iec104/iec104_source.c only.
|
||||
*
|
||||
* Ranks are uint16_t because the largest rank is 344 (configured) / 263 (writable),
|
||||
* both above 0xFF. A uint8_t table would alias sentinel 0xFF with rank 255 and
|
||||
* silently mis-map one parameter, so uint8_t is not an option here.
|
||||
*/
|
||||
#ifndef IEC104_SOURCE_RANKS_H
|
||||
#define IEC104_SOURCE_RANKS_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#define IEC104_SOURCE_CONFIGURED_TOTAL 345U
|
||||
#define IEC104_SOURCE_SCOPED_TOTAL 88U
|
||||
#define IEC104_SOURCE_WRITABLE_TOTAL 264U
|
||||
#define IEC104_SOURCE_STAGE_NO_RANK 0xFFFFU
|
||||
|
||||
/* Dense value slots: configured in area 0, area_scoped in areas 1..4. */
|
||||
#define IEC104_SOURCE_VALUE_SLOTS \
|
||||
(IEC104_SOURCE_CONFIGURED_TOTAL + 4U * IEC104_SOURCE_SCOPED_TOTAL)
|
||||
#define IEC104_SOURCE_STAGE_SLOTS IEC104_SOURCE_WRITABLE_TOTAL
|
||||
#define IEC104_SOURCE_DIRTY_BYTES ((IEC104_SOURCE_WRITABLE_TOTAL + 7U) / 8U)
|
||||
|
||||
/* rank among configured parameters -> area-0 value slot (0xFFFF = not visible) */
|
||||
static const uint16_t iec104_source_value_rank[430] = {
|
||||
0U, 1U, 2U, 3U, 4U, 5U, 6U, 7U,
|
||||
8U, 9U, 10U, 11U, 12U, 13U, 14U, 15U,
|
||||
16U, 17U, 18U, 19U, 20U, 21U, 22U, 23U,
|
||||
24U, 25U, 26U, 27U, 28U, 29U, 30U, 31U,
|
||||
32U, 33U, 34U, 35U, 36U, 37U, 38U, 39U,
|
||||
40U, 41U, 42U, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 43U, 44U, 45U, 46U, 47U, 48U, 49U,
|
||||
50U, 51U, 52U, 53U, 54U, 55U, 56U, 57U,
|
||||
58U, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 59U,
|
||||
60U, 61U, 62U, 63U, 64U, 65U, 66U, 67U,
|
||||
68U, 69U, 70U, 71U, 72U, 73U, 74U, 75U,
|
||||
76U, 77U, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 78U, 79U,
|
||||
80U, 81U, 82U, 83U, 84U, 85U, 86U, 87U,
|
||||
88U, 89U, 90U, 91U, 92U, 93U, 94U, 95U,
|
||||
96U, 97U, 98U, 99U, 100U, 101U, 102U, 103U,
|
||||
104U, 105U, 106U, 107U, 108U, 109U, 110U, 111U,
|
||||
112U, 113U, 114U, 115U, 116U, 117U, 118U, 119U,
|
||||
120U, 121U, 122U, 123U, 124U, 125U, 126U, 127U,
|
||||
128U, 129U, 130U, 131U, 132U, 133U, 134U, 135U,
|
||||
136U, 137U, 138U, 139U, 140U, 141U, 142U, 143U,
|
||||
144U, 145U, 146U, 147U, 148U, 149U, 150U, 151U,
|
||||
152U, 153U, 154U, 155U, 156U, 157U, 158U, 159U,
|
||||
160U, 161U, 162U, 163U, 164U, 165U, 166U, 167U,
|
||||
168U, 169U, 170U, 171U, 172U, 173U, 174U, 175U,
|
||||
176U, 177U, 178U, 179U, 180U, 181U, 182U, 183U,
|
||||
184U, 185U, 186U, 187U, 188U, 189U, 190U, 191U,
|
||||
192U, 193U, 194U, 195U, 196U, 197U, 198U, 199U,
|
||||
200U, 201U, 202U, 203U, 204U, 205U, 206U, 207U,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 208U, 209U, 210U,
|
||||
211U, 212U, 213U, 214U, 215U, 216U, 217U, 218U,
|
||||
219U, 220U, 221U, 222U, 223U, 224U, 225U, 226U,
|
||||
227U, 228U, 229U, 230U, 231U, 232U, 233U, 234U,
|
||||
235U, 236U, 237U, 238U, 239U, 240U, 241U, 242U,
|
||||
243U, 244U, 245U, 246U, 247U, 248U, 249U, 250U,
|
||||
251U, 252U, 253U, 254U, 255U, 256U, 257U, 258U,
|
||||
259U, 260U, 261U, 262U, 263U, 264U, 265U, 266U,
|
||||
267U, 268U, 269U, 270U, 271U, 272U, 273U, 274U,
|
||||
275U, 276U, 277U, 278U, 279U, 280U, 281U, 282U,
|
||||
283U, 284U, 285U, 286U, 287U, 288U, 289U, 290U,
|
||||
291U, 292U, 293U, 294U, 295U, 296U, 297U, 298U,
|
||||
299U, 300U, 301U, 302U, 303U, 304U, 305U, 306U,
|
||||
307U, 308U, 309U, 310U, 311U, 312U, 313U, 314U,
|
||||
315U, 316U, 317U, 318U, 319U, 320U, 321U, 322U,
|
||||
323U, 324U, 325U, 326U, 327U, 328U, 329U, 330U,
|
||||
331U, 332U, 333U, 334U, 335U, 336U, 337U, 338U,
|
||||
339U, 340U, 341U, 342U, 343U, 344U,
|
||||
};
|
||||
|
||||
/* rank among area_scoped parameters -> offset inside one area bank */
|
||||
static const uint16_t iec104_source_scope_rank[430] = {
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0U, 1U,
|
||||
2U, 3U, 4U, 5U, 6U, 7U, 8U, 9U,
|
||||
10U, 11U, 12U, 13U, 14U, 15U, 16U, 17U,
|
||||
18U, 19U, 20U, 21U, 22U, 23U, 24U, 25U,
|
||||
26U, 27U, 28U, 29U, 30U, 31U, 32U, 33U,
|
||||
34U, 35U, 36U, 37U, 38U, 39U, 40U, 41U,
|
||||
42U, 43U, 44U, 45U, 46U, 47U, 48U, 49U,
|
||||
50U, 51U, 52U, 53U, 54U, 55U, 56U, 57U,
|
||||
58U, 59U, 60U, 61U, 62U, 63U, 64U, 65U,
|
||||
66U, 67U, 68U, 69U, 70U, 71U, 72U, 73U,
|
||||
74U, 75U, 76U, 77U, 78U, 79U, 80U, 81U,
|
||||
82U, 83U, 84U, 85U, 86U, 87U, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
};
|
||||
|
||||
/* rank among writable parameters -> staged[] slot and dirty bit index */
|
||||
static const uint16_t iec104_source_stage_rank[430] = {
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0U, 1U,
|
||||
2U, 3U, 4U, 5U, 6U, 7U, 8U, 9U,
|
||||
10U, 11U, 12U, 13U, 14U, 15U, 16U, 17U,
|
||||
18U, 19U, 20U, 21U, 22U, 23U, 24U, 25U,
|
||||
26U, 27U, 28U, 29U, 30U, 31U, 32U, 33U,
|
||||
34U, 35U, 36U, 37U, 38U, 39U, 40U, 41U,
|
||||
42U, 43U, 44U, 45U, 46U, 47U, 48U, 49U,
|
||||
50U, 51U, 52U, 53U, 54U, 55U, 56U, 57U,
|
||||
58U, 59U, 60U, 61U, 62U, 63U, 64U, 65U,
|
||||
66U, 67U, 68U, 69U, 70U, 71U, 72U, 73U,
|
||||
74U, 75U, 76U, 77U, 78U, 79U, 80U, 81U,
|
||||
82U, 83U, 84U, 85U, 86U, 87U, 88U, 89U,
|
||||
90U, 91U, 92U, 93U, 94U, 95U, 96U, 97U,
|
||||
98U, 99U, 100U, 101U, 102U, 103U, 104U, 105U,
|
||||
106U, 107U, 108U, 109U, 110U, 111U, 112U, 113U,
|
||||
114U, 115U, 116U, 117U, 118U, 119U, 120U, 121U,
|
||||
122U, 123U, 124U, 125U, 126U, 127U, 128U, 129U,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU, 0xFFFFU,
|
||||
130U, 131U, 132U, 133U, 134U, 135U, 136U, 137U,
|
||||
138U, 139U, 140U, 141U, 142U, 143U, 144U, 145U,
|
||||
146U, 147U, 148U, 149U, 150U, 151U, 152U, 153U,
|
||||
154U, 155U, 156U, 157U, 158U, 159U, 160U, 161U,
|
||||
162U, 163U, 164U, 165U, 166U, 167U, 168U, 169U,
|
||||
170U, 171U, 172U, 173U, 174U, 175U, 176U, 177U,
|
||||
178U, 179U, 180U, 181U, 182U, 183U, 184U, 185U,
|
||||
186U, 187U, 188U, 189U, 190U, 191U, 192U, 193U,
|
||||
194U, 195U, 196U, 197U, 198U, 199U, 200U, 201U,
|
||||
202U, 203U, 204U, 205U, 206U, 207U, 208U, 209U,
|
||||
210U, 211U, 212U, 213U, 214U, 215U, 216U, 217U,
|
||||
218U, 219U, 220U, 221U, 222U, 223U, 224U, 225U,
|
||||
226U, 227U, 228U, 229U, 230U, 231U, 232U, 233U,
|
||||
234U, 235U, 236U, 237U, 238U, 239U, 240U, 241U,
|
||||
242U, 243U, 244U, 245U, 246U, 247U, 248U, 249U,
|
||||
250U, 251U, 252U, 253U, 254U, 255U, 256U, 257U,
|
||||
258U, 259U, 260U, 261U, 262U, 263U,
|
||||
};
|
||||
|
||||
#endif /* IEC104_SOURCE_RANKS_H */
|
||||
Reference in New Issue
Block a user