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