rts-sim-testing-service/third_party/message/rssp_code.go

package message

import "github.com/snksoft/crc"

//rssp 协议中crc校验，查表法实现

var (
	// crc16多项式为G(x)=X16+X11+X4+1
	RSSP_I_CRC16 = crc.NewHash(&crc.Parameters{Width: 16, Polynomial: 0x0811, Init: 0x0, ReflectIn: true, ReflectOut: true, FinalXor: 0x0})
	// 通道1 crc32多项式为0x100d4e63
	RSSP_I_C1_CRC32 = crc.NewHash(&crc.Parameters{Width: 32, Polynomial: 0x100d4e63, Init: 0x0, ReflectIn: true, ReflectOut: true, FinalXor: 0x0})
	// 通道2 crc32多项式为0x8ce56011
	RSSP_I_C2_CRC32 = crc.NewHash(&crc.Parameters{Width: 32, Polynomial: 0x8ce56011, Init: 0x0, ReflectIn: true, ReflectOut: true, FinalXor: 0x0})
)

// Rssp_I_Crc16计算
func Rssp_I_Crc16(data []byte) uint16 {
	return uint16(RSSP_I_CRC16.CalculateCRC(data))
}

// 通道1的crc32
func Rssp_I_Crc32C1(data []byte) uint32 {
	var result byte
	for i, b := range data {
		result = 0
		for i := 0; i < 8; i++ {
			result <<= 1
			result |= b & 1
			b >>= 1
		}
		data[i] = result
	}
	return uint32(RSSP_I_C1_CRC32.CalculateCRC(data))
}

// 通道2的crc32
func Rssp_I_Crc32C2(data []byte) uint32 {
	var result byte
	for i, b := range data {
		result = 0
		for i := 0; i < 8; i++ {
			result <<= 1
			result |= b & 1
			b >>= 1
		}
		data[i] = result
	}
	return uint32(RSSP_I_C2_CRC32.CalculateCRC(data))
}