添加遥控、参数装载、文件传输等业务
This commit is contained in:
@@ -0,0 +1,208 @@
|
||||
/* 独立主站:只链接 lib60870-C 7a388e3e133999e1ca77ba7521d55d074b7cd2bc,
|
||||
* 不包含被测从站头文件,使用外部库构造请求并解析确认/总召/周期数据。
|
||||
* 导航:接收线程核对 -> 同步单请求等待 -> 总召读回 -> 标准与扩展场景。
|
||||
* 与可控夹具测试互补:这里验证跨协议栈线格式和真实 ACK 生效路径,不注入内部故障。 */
|
||||
#include "cs104_connection.h"
|
||||
#include "hal_thread.h"
|
||||
#include <stdatomic.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
|
||||
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;
|
||||
}
|
||||
Reference in New Issue
Block a user