/* 独立主站:只链接 lib60870-C 7a388e3e133999e1ca77ba7521d55d074b7cd2bc, * 不包含被测从站头文件,使用外部库构造请求并解析确认/总召/周期数据。 * 导航:接收线程核对 -> 同步单请求等待 -> 总召读回 -> 标准与扩展场景。 * 与可控夹具测试互补:这里验证跨协议栈线格式和真实 ACK 生效路径,不注入内部故障。 */ #include "cs104_connection.h" #include "hal_thread.h" #include #include #include typedef struct { int type, ioa, qualifier, cot, value; bool negative, test; } Expected; /* 主线程先写 expected,再发布 pending=1;接收线程看到 pending 后才读 expected, * 核对完成发布 pending=0,主线程等待它清零才改写下一条期望。默认顺序一致的 * 原子操作完成跨线程交接;总召值和周期计数也用原子变量,不能改成 volatile。 */ static Expected expected; static atomic_int pending, failed, collecting, gi_done, gi_mask, cyclic_count; static atomic_int gi_values[6]; #define CHECK(x) do { if (!(x)) { fprintf(stderr, "line %d: %s\n", __LINE__, #x); atomic_store(&failed, 1); } } while (0) /** * 功能:lib60870-C 的接收线程调用。 * 输入参数:context——业务回调的测试上下文;address——监听地址或接收报文的公共地址;asdu——ASDU 容器。 * 输出参数:无。 * 返回值:true 表示本次操作或核对成功;false 表示拒绝、失败或命中注入故障。 * 说明:周期数据可能穿插在确认/总召之间,按类型与 COT * 分流;总召用 (IOA, Type, KPA) 定位,尤其不能把同址 2001 的两种参数合并。 */ static bool receive_asdu(void *context, int address, CS101_ASDU asdu) { InformationObject object; int type = CS101_ASDU_getTypeID(asdu), cot = CS101_ASDU_getCOT(asdu), ioa, q = 0, value = 0; (void)context; (void)address; CHECK(CS101_ASDU_getCA(asdu) == 1); CHECK(CS101_ASDU_getNumberOfElements(asdu) == 1 && !CS101_ASDU_isSequence(asdu)); object = CS101_ASDU_getElement(asdu, 0); if (object == NULL) { CHECK(false); return false; } ioa = InformationObject_getObjectAddress(object); if (type == 110) { value = (int)(ParameterNormalizedValue_getValue((ParameterNormalizedValue)object) * 32768.0f); q = ParameterNormalizedValue_getQPM((ParameterNormalizedValue)object); } else if (type == 111) { value = ParameterScaledValue_getValue((ParameterScaledValue)object); q = ParameterScaledValue_getQPM((ParameterScaledValue)object); } else if (type == 112) { value = (int)(ParameterFloatValue_getValue((ParameterFloatValue)object) * 1000.0f); q = ParameterFloatValue_getQPM((ParameterFloatValue)object); } else if (type == 113) q = ParameterActivation_getQuality((ParameterActivation)object); if (type == 11 && cot == 1) { CHECK(ioa == 3001 && !CS101_ASDU_isTest(asdu) && !CS101_ASDU_isNegative(asdu)); CHECK(MeasuredValueScaled_getValue((MeasuredValueScaled)object) == 123); atomic_fetch_add(&cyclic_count, 1); } else if (type == 100) { CHECK(atomic_load(&collecting) && !CS101_ASDU_isNegative(asdu)); CHECK(cot == 7 || cot == 10); if (cot == 10) atomic_store(&gi_done, 1); } else if (cot == 20 && type >= 110 && type <= 112) { int index = ioa == 1001 && type == 110 && q == 1 ? 0 : ioa == 1002 && type == 111 && q == 1 ? 1 : ioa == 1003 && type == 112 && q == 2 ? 2 : ioa == 2001 && type == 111 && q == 1 ? 3 : ioa == 2001 && type == 111 && q == 3 ? 4 : ioa == 2002 && type == 112 && q == 2 ? 5 : -1; CHECK(atomic_load(&collecting) && index >= 0); CHECK(!CS101_ASDU_isNegative(asdu) && !CS101_ASDU_isTest(asdu)); if (index >= 0) { CHECK((atomic_load(&gi_mask) & (1 << index)) == 0); atomic_store(&gi_values[index], value); atomic_fetch_or(&gi_mask, 1 << index); } } else if (atomic_load(&pending)) { CHECK(type == expected.type && cot == expected.cot && ioa == expected.ioa && q == expected.qualifier); CHECK(CS101_ASDU_getOA(asdu) == 7); CHECK(CS101_ASDU_isNegative(asdu) == expected.negative && CS101_ASDU_isTest(asdu) == expected.test); if (type != 113) CHECK(value == expected.value); atomic_store(&pending, 0); } else CHECK(false); /* getElement 每次分配一个信息对象,回调结束前归还,不能当作 ASDU 内部借用。 */ InformationObject_destroy(object); return !atomic_load(&failed); } /** * 功能:每5ms检查一次交接标志,最多等待1000次。 * 输入参数:flag——回调线程与主线程共享的原子标志。 * 输出参数:无。 * 返回值:等待期间未出现接收检查失败时返回 true;出现失败返回 false,超时未清标志由 CHECK 报错。 * 说明:回调失败提前结束,超时标志未清也判失败。 */ static bool wait_clear(atomic_int *flag) { unsigned n; for (n = 0; n < 1000 && atomic_load(flag) && !atomic_load(&failed); ++n) Thread_sleep(5); CHECK(!atomic_load(flag)); return !atomic_load(&failed); } /** * 功能:每次只等一条确认,OA 固定为 7 以验证回显。 * 输入参数:connection——测试主站连接;type——协议类型或期望事件类型;ioa——信息对象地址;q——参数限定词;value——测试对象值或原始位模式;cot——完整传送原因字节;test——是否设置 TEST 位;negative_request——是否设置请求 P/N 位;reply_cot——期望回复传送原因;negative_reply——期望回复是否为否定确认;reply_value——期望回复对象值。 * 输出参数:无。 * 返回值:true 表示本次操作或核对成功;false 表示拒绝、失败或命中注入故障。 * 说明:直接建 ASDU 才能设置 TEST/P/N; * Type 110 的输入是原始定点整数,Type 112 使用千分之一单位,适合本组精确用例。 */ static bool command(CS104_Connection connection, int type, int ioa, int q, int value, int cot, bool test, bool negative_request, int reply_cot, bool negative_reply, int reply_value) { InformationObject object; CS101_ASDU asdu; bool sent; expected = (Expected){type, ioa, q, reply_cot, reply_value, negative_reply, test}; atomic_store(&pending, 1); if (type == 110) object = (InformationObject)ParameterNormalizedValue_create(NULL, ioa, value / 32768.0f, (uint8_t)q); else if (type == 111) object = (InformationObject)ParameterScaledValue_create(NULL, ioa, value, (uint8_t)q); else if (type == 112) object = (InformationObject)ParameterFloatValue_create(NULL, ioa, value / 1000.0f, (uint8_t)q); else object = (InformationObject)ParameterActivation_create(NULL, ioa, (uint8_t)q); if (object == NULL) { CHECK(false); return false; } asdu = CS101_ASDU_create(CS104_Connection_getAppLayerParameters(connection), false, (CS101_CauseOfTransmission)cot, 7, 1, test, negative_request); if (asdu == NULL) { InformationObject_destroy(object); CHECK(false); return false; } CHECK(CS101_ASDU_addInformationObject(asdu, object)); sent = CS104_Connection_sendASDU(connection, asdu); CS101_ASDU_destroy(asdu); InformationObject_destroy(object); CHECK(sent); return wait_clear(&pending); } /** * 功能:发起总召读回并核对参数集合,确认前序参数应答的 ACK 已被子站处理。 * 输入参数:connection——测试主站连接;staged_float——期望暂存的浮点参数。 * 输出参数:无。 * 返回值:true 表示本次操作或核对成功;false 表示拒绝、失败或命中注入故障。 * 说明:确认到达只证明主站收到帧;总召逐项读回用于验证运行值确已生效。 * 六位掩码同时检查遗漏/重复,staged_float 区分 QPA=2 与 QPA=1 的激活范围。 */ static bool interrogation(CS104_Connection connection, int staged_float) { const int values[] = {16384,200,2500,300,-10,staged_float}; unsigned n; atomic_store(&gi_mask, 0); atomic_store(&gi_done, 0); atomic_store(&collecting, 1); CHECK(CS104_Connection_sendInterrogationCommand(connection, CS101_COT_ACTIVATION, 1, IEC60870_QOI_STATION)); for (n = 0; n < 1000 && !atomic_load(&gi_done) && !atomic_load(&failed); ++n) Thread_sleep(5); CHECK(atomic_load(&gi_done) && atomic_load(&gi_mask) == 63); for (n = 0; n < 6; ++n) CHECK(atomic_load(&gi_values[n]) == values[n]); atomic_store(&collecting, 0); return !atomic_load(&failed); } /** * 功能:用独立lib60870主站连接指定回环端口,核对参数确认、ACK后总召读回和周期启停。 * 输入参数:argc——命令行参数数量;argv——命令行参数数组。 * 输出参数:无。 * 返回值:正常完成返回 0;参数、运行或断言失败以非零状态结束进程。 * 说明:检查不满足时由 CHECK 立即报告失败,不继续本用例。 */ int main(int argc, char **argv) { CS104_Connection connection; CS104_APCIParameters apci; unsigned n; int stopped_count; if (argc != 2) return 2; connection = CS104_Connection_create("127.0.0.1", atoi(argv[1])); if (connection == NULL) return 2; apci = CS104_Connection_getAPCIParameters(connection); apci->w = 1; /* 每个 I 帧尽快自动 ACK,随后读回应能看到从站 COMMIT 的结果。 */ CS104_Connection_setASDUReceivedHandler(connection, receive_asdu, NULL); if (!CS104_Connection_connect(connection)) { CS104_Connection_destroy(connection); return 1; } CS104_Connection_sendStartDT(connection); Thread_sleep(100); #define SEND(t,i,q,v,c,test,nr,rc,rn,rv) do { if (!command(connection,t,i,q,v,c,test,nr,rc,rn,rv)) goto done; } while (0) /* 三种装载的肯定/否定运行值,以及 TEST 不写入、P/N 拒绝和 QPM 整字节回显。 */ SEND(110,1001,1,16384,6,false,false,7,false,16384); SEND(110,1001,1,-1,6,false,false,7,true,16384); SEND(110,1001,1,24576,6,true,false,7,false,16384); SEND(111,1002,1,200,6,false,false,7,false,200); SEND(111,1002,1,-1,6,false,false,7,true,200); SEND(111,1002,0xC1,999,6,false,true,7,true,200); SEND(112,1003,2,2500,6,false,false,7,false,2500); SEND(112,1003,2,61000,6,false,false,7,true,2500); /* 暂存确认带旧值;QPA=2 先激活同址两行,QPA=1 再激活剩余浮点参数。 */ SEND(111,2001,1,300,6,false,false,7,false,100); SEND(111,2001,3,-10,6,false,false,7,false,-100); SEND(112,2002,2,4500,6,false,false,7,false,500); SEND(113,2001,2,0,6,false,false,7,false,0); if (!interrogation(connection, 500)) goto done; SEND(113,0,1,0,6,false,false,7,false,0); if (!interrogation(connection, 4500)) goto done; /* TEST 停止激活不改变周期流;真实停用后先让已经排队的数据排空,再比较 * 一个超过两个配置周期的观测窗,避免把在途帧误判为停用失败。 */ SEND(113,3001,3,0,8,true,false,9,false,0); atomic_store(&cyclic_count, 0); for (n = 0; n < 200 && atomic_load(&cyclic_count) == 0 && !atomic_load(&failed); ++n) Thread_sleep(5); CHECK(atomic_load(&cyclic_count) > 0); SEND(113,3001,3,0,8,false,false,9,false,0); Thread_sleep(300); stopped_count = atomic_load(&cyclic_count); Thread_sleep(450); CHECK(atomic_load(&cyclic_count) == stopped_count); SEND(113,3001,3,0,6,false,false,7,false,0); for (n = 0; n < 200 && atomic_load(&cyclic_count) == stopped_count && !atomic_load(&failed); ++n) Thread_sleep(5); CHECK(atomic_load(&cyclic_count) > stopped_count); SEND(113,9999,3,0,6,false,false,47,true,0); SEND(113,4001,128,0,6,false,false,7,false,0); SEND(113,4001,128,0,8,false,false,9,false,0); /* 接收回调先于库的自动 ACK。最后再往返一轮总召,避免 close 抢在最后一份 * 肯定确认的 ACK 之前断线,导致从站按约定 ABORT 最后一次准备。 */ if (!interrogation(connection, 4500)) goto done; done: CS104_Connection_close(connection); CS104_Connection_destroy(connection); if (atomic_load(&failed)) return 1; puts("lib60870-C Parameter PASS: 110/111/112 values, TEST/PN/QPM, staged QPA1/2, shared IOA, QPA3, private QPA, GI"); return 0; }