diff --git a/comm/protocols/slmptcpmaster.c b/comm/protocols/slmptcpmaster.c index 0a380ef..f5e5794 100644 --- a/comm/protocols/slmptcpmaster.c +++ b/comm/protocols/slmptcpmaster.c @@ -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; }