refactor: SLMP改用和FINS完全一致的myRtumST[20]数组,奇数读偶数写,和Fins架构完全对齐

This commit is contained in:
claw committed 2026-04-02 23:03:26 +08:00
1 parent 102e59d033
commit e3f5a5af6d
1 file changed
+21 -37
+21 -37
View File
@@ -111,7 +111,7 @@ _Bool slmp_handle_recv(uint16_t size) {
// 因为发送后索引立即+1,所以响应对应发送前的索引
uint16_t prevIdx;
if (slmp_idx == 0) {
prevIdx = 9; // 绕回
prevIdx = 19; // 绕回 (0~19共20个索引,和FINS一致)
} else {
prevIdx = slmp_idx - 1;
}
@@ -122,7 +122,7 @@ _Bool slmp_handle_recv(uint16_t size) {
}
// 4. 获取参数,检查长度合法性
uint16_t pointNum = get_register(readST[prevIdx].size);
uint16_t pointNum = get_register(myRtumST[prevIdx].size);
if (pointNum > 20 || pointNum * 2 + 11 != size) {
return false; // 长度不匹配或超出最大限制,丢弃
}
@@ -133,7 +133,7 @@ _Bool slmp_handle_recv(uint16_t size) {
uint8_t byte_l = slmp_rxbuf[i * 2 + 11];
uint8_t byte_h = slmp_rxbuf[i * 2 + 12];
uint16_t value = ((uint16_t)byte_l) | (((uint16_t)byte_h) << 8);
// 存储地址: 1200 + (索引*20) + 偏移
// 存储地址: 1200 + (索引*20) + 偏移 (和FINS一致)
set_register(1200 + (20 * prevIdx) + i, value);
}
@@ -143,29 +143,26 @@ _Bool slmp_handle_recv(uint16_t size) {
/**
* @brief 构建SLMP请求帧
* @return 发送长度,0表示不发送(参数非法)
* @note 奇数索引 -> 读操作(readST), 偶数索引 -> 写操作(writeST)
* @note 和FINS完全一致: 使用myRtumST[20],奇数索引读,偶数索引写
* 读: 存储到 1200 + (idx*20) + i
* 写: 从 1200 + (idx*20) + i 读取
*/
uint16_t slmp_build_send(void) {
uint16_t sendsize = 0;
uint16_t slave_id;
uint16_t plc_address;
uint16_t pointNum;
uint16_t slave_id = get_register(myRtumST[slmp_idx].slave_id);
uint16_t plc_address = get_register(myRtumST[slmp_idx].plc_address);
uint16_t pointNum = get_register(myRtumST[slmp_idx].size);
// 参数合法性检查
if (slave_id < 0x01 || slave_id > 0xF7 || pointNum == 0 || pointNum > 20) {
return 0;
}
if ((plc_address + pointNum) >= 8000) {
return 0; // 地址越界
}
// ========== 奇数索引: 读操作 ==========
if (slmp_idx % 2 == 1) {
// 从readST获取参数
slave_id = get_register(readST[slmp_idx].slave_id);
plc_address = get_register(readST[slmp_idx].plc_address);
pointNum = get_register(readST[slmp_idx].size);
// 参数合法性检查
if (slave_id < 0x01 || slave_id > 0xF7 || pointNum == 0 || pointNum > 20) {
return 0;
}
if ((plc_address + pointNum) >= 8000) {
return 0; // 地址越界
}
// 构建读请求帧
slmp_frame.frameStruct.cmd = 0x0401; // 读命令码
slmp_frame.frameStruct.requestSize = 0x000C; // 请求长度固定12字节
@@ -180,19 +177,6 @@ uint16_t slmp_build_send(void) {
}
// ========== 偶数索引: 写操作 ==========
else {
// 从writeST获取参数
slave_id = get_register(writeST[slmp_idx].slave_id);
plc_address = get_register(writeST[slmp_idx].plc_address);
pointNum = get_register(writeST[slmp_idx].size);
// 参数合法性检查
if (slave_id < 0x01 || slave_id > 0xF7 || pointNum == 0 || pointNum > 20) {
return 0;
}
if ((plc_address + pointNum) >= 8000) {
return 0; // 地址越界
}
sendsize = 21 + (pointNum * 2); // 帧头21字节 + 数据2字节*点数
if (sendsize > sizeof(slmp_txbuf)) {
return 0; // 超出缓冲区,安全保护
@@ -204,9 +188,9 @@ uint16_t slmp_build_send(void) {
slmp_frame.frameStruct.start = u32_to_slmp24(plc_address);
slmp_frame.frameStruct.size = pointNum;
// 填充数据: SLMP小端序,低字节在前
// 填充数据: 从寄存器映射读取,SLMP小端序,低字节在前
for (int i = 0; i < pointNum; i++) {
uint16_t value = get_register(1000 + (20 * slmp_idx) + i);
uint16_t value = get_register(1200 + (20 * slmp_idx) + i);
slmp_txbuf[i * 2 + 21] = value & 0xFF; // 低字节在前
slmp_txbuf[i * 2 + 22] = (value >> 8) & 0xFF; // 高字节在后
}
@@ -217,8 +201,8 @@ uint16_t slmp_build_send(void) {
}
}
// 索引轮转,下次处理下一个通道
slmp_idx = (slmp_idx + 1) % 10;
// 索引轮转,下次处理下一个通道 (和FINS完全一样)
slmp_idx = (slmp_idx + 1) % 20;
return sendsize;
}