refactor: SLMP改用和FINS完全一致的myRtumST[20]数组,奇数读偶数写,和Fins架构完全对齐
This commit is contained in:
1 parent
102e59d033
commit
e3f5a5af6d
1 file changed
+21
-37
@@ -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;
|
||||
}
|
||||
|
||||
|
||||
Reference in new issue
Block a user