rtu_transport.go

@@ -80,7 +80,6 @@ func (rt *rtuTransport) ExecuteRequest(req *pdu) (res *pdu, err error) {
 	// build an RTU ADU out of the request object and
 	// send the final ADU+CRC on the wire
 	n, err = rt.link.Write(rt.assembleRTUFrame(req))
-	fmt.Printf("send: %X\n", rt.assembleRTUFrame(req))
 	if err != nil {
 		fmt.Printf("write error: %s", err.Error())
 		return
@@ -189,6 +188,55 @@ func (rt *rtuTransport) WriteResponse(res *pdu) (err error) {
 	return
 }
 
+func calculateModbusCRC16(data []byte) uint16 {
+	// 初始值 (标准 Modbus RTU)
+	var crc uint16 = 0xFFFF
+
+	// 遍历所有需要校验的字节
+	for _, b := range data {
+		// 1. 当前 CRC 异或当前字节 (注意：字节 b 转换为 uint16)
+		crc = crc ^ uint16(b)
+
+		// 2. 8 次迭代进行位运算
+		for i := 0; i < 8; i++ {
+			// 检查最低有效位 (LSB)
+			if crc&0x0001 != 0 {
+				// 如果 LSB 是 1: 右移一位，然后异或多项式 0xA001
+				// 0xA001 是 0x8005 反射后的结果
+				crc = (crc >> 1) ^ 0xA001
+			} else {
+				// 如果 LSB 是 0: 直接右移一位
+				crc = crc >> 1
+			}
+		}
+	}
+
+	// 3. 返回最终的 CRC 值
+	return crc
+}
+
+// 示例用法：使用此函数替换您原来的 crc.add/crc.value 逻辑
+
+// 假设您的数据帧已完整接收到 rxbuf 中
+func checkCRC(rxbuf []byte, totalFrameSize int) bool {
+	// 1. 确定校验范围 (地址到数据结束)
+	crcEndIndex := totalFrameSize - 2
+	dataToVerify := rxbuf[0:crcEndIndex]
+
+	// 2. 使用模拟从机的函数计算 CRC
+	calculatedCRC := calculateModbusCRC16(dataToVerify)
+
+	// 3. 提取接收到的 CRC (Little-Endian 顺序)
+	recvCRCLow := rxbuf[crcEndIndex]
+	recvCRCHigh := rxbuf[crcEndIndex+1]
+
+	// 4. 重组接收到的 CRC
+	receivedCRC := (uint16(recvCRCHigh) << 8) | uint16(recvCRCLow)
+
+	// 5. 比较
+	return calculatedCRC == receivedCRC
+}
+
 // Waits for, reads and decodes a frame from the rtu link.
 func (rt *rtuTransport) readRTUFrame() (res *pdu, err error) {
 	var rxbuf []byte
@@ -206,9 +254,9 @@ func (rt *rtuTransport) readRTUFrame() (res *pdu, err error) {
 		err = ErrShortFrame
 		return
 	}
-	if uint8(rxbuf[1]) == fcCustomize {
+	// if uint8(rxbuf[1]) == fcCustomize {
-		fmt.Printf("receive: %v\n", rxbuf[0:3])
+	// 	fmt.Printf("receive: %v\n", rxbuf[0:3])
-	}
+	// }
 	if err != nil && err != io.ErrUnexpectedEOF {
 		return
 	}
@@ -233,7 +281,6 @@ func (rt *rtuTransport) readRTUFrame() (res *pdu, err error) {
 		// 数据长度位于 rxbuf[4] 和 rxbuf[5]
 		dataLength := bytesToUint16(BIG_ENDIAN, rxbuf[4:6])
 		bytesNeeded = int(dataLength)
-		fmt.Println(bytesNeeded)
 
 		// 3. 计算总共需要读取的字节数
 		// 数据域长度 + 2 字节 CRC
@@ -276,20 +323,30 @@ func (rt *rtuTransport) readRTUFrame() (res *pdu, err error) {
 
 		// 7. CRC 校验
 		crcEndIndex := totalFrameSize - 2 // CRC 校验范围的结束索引 (不包含)
-		fmt.Println("crc end index", crcEndIndex)
+
+		// if checkCRC(rxbuf, totalFrameSize) {
+		// 	fmt.Println("66666666666666")
+		// }
 
 		crc.init()
 		crc.add(rxbuf[0:crcEndIndex]) // 校验范围从 rxbuf[0] 到数据域结束
 
 		// 比较接收到的 CRC
-		// recvCRCLow := rxbuf[crcEndIndex]
+		// sentHigh := rxbuf[crcEndIndex]  // C_high (例如 0x8B)
-		// recvCRCHigh := rxbuf[crcEndIndex+1]
+		// sentLow := rxbuf[crcEndIndex+1] // C_low (例如 0xB0)
 
-		// fmt.Println("len: ", len(rxbuf[6:crcEndIndex]))
+		// 由于 isEqual 期望 (low, high)，我们需要将 sentLow 传给 low
 
-		// if !crc.isEqual(recvCRCLow, recvCRCHigh) {
+		// fmt.Printf("ddd: % X\n", rxbuf)
+		// fmt.Println("c.crc: ", crc.crc)
+		// fmt.Println("sentLow: ", sentLow, "sentHigh: ", sentHigh)
+		// fmt.Println("rxbuf[0:10]: ", rxbuf[0:10], "rxbuf[crcEndIndex-10:crcEndIndex]: ", rxbuf[crcEndIndex-10:crcEndIndex])
+
+		// fmt.Println("len: ", len(rxbuf[crcEndIndex-10:crcEndIndex]))
+
+		// if !crc.isEqual(sentLow, sentHigh) {
 		// 	err = ErrBadCRC
-		// 	fmt.Println("crc: ", recvCRCLow, recvCRCHigh, "byte needed: ", bytesNeeded)
+		// 	fmt.Println("crc: ", sentLow, sentHigh, "byte needed: ", bytesNeeded)
 		// 	return
 		// }
 
@@ -413,6 +470,13 @@ func (rt *rtuTransport) readRTUFrameWithRes() (res *pdu, err error) {
 		return
 	}
 
+	// fmt.Println("---: ", rxbuf[:10])
+
+	// a := make([]byte, 100)
+	// n, err := io.ReadFull(rt.link, a)
+	// fmt.Println("n: ", n, "err: ", err, "a: ", a)
+	time.Sleep(1 * time.Second)
+
 	// 使用临时缓冲区循环读取自定义数据
 	tempBuf := make([]byte, 256) // 每次读取最多256字节
 	totalRead := 0
@@ -476,6 +540,7 @@ func (rt *rtuTransport) readRTUFrameWithRes() (res *pdu, err error) {
 		functionCode: rxbuf[1],
 		// payload包含标准响应的payload + 自定义数据
 		payload: completePayload,
+		// payload: a,
 	}
 
 	return