118 lines
2.9 KiB
Go
118 lines
2.9 KiB
Go
package message
|
||
|
||
import "encoding/binary"
|
||
|
||
//RSSP-1 V1.0 铁路信号安全通信协议
|
||
|
||
// RsspHead rssp报文头
|
||
type RsspHead struct {
|
||
//报文头-协议交互类别(1Byte)
|
||
Pic byte
|
||
//报文头-报文类别(1Byte)
|
||
Mc byte
|
||
//报文头-源地址(2Byte)
|
||
Sa uint16
|
||
//报文头-目地址(2Byte)
|
||
Da uint16
|
||
}
|
||
|
||
// RsspRsd 实时安全数据包
|
||
type RsspRsd struct {
|
||
RsspHead
|
||
//安全校验域-序列号(4Byte)
|
||
Sn uint32
|
||
//安全校验域-安全数据长度(2Byte)
|
||
Sdl uint16
|
||
//安全校验域-安全校验通道1(4Byte)
|
||
Svc1 uint32
|
||
//安全校验域-安全校验通道2(4Byte)
|
||
Svc2 uint32
|
||
//用户数据包-安全应用数据(总字节数480)
|
||
Sad []byte
|
||
//报文尾-CRC16(2Byte)
|
||
Crc16 uint16
|
||
}
|
||
|
||
func (r *RsspRsd) Encode() []byte {
|
||
data := make([]byte, 0, 6+14+len(r.Sad)+2)
|
||
//报文头
|
||
data = append(data, r.Pic)
|
||
data = append(data, r.Mc)
|
||
data = binary.LittleEndian.AppendUint16(data, r.Sa)
|
||
data = binary.LittleEndian.AppendUint16(data, r.Da)
|
||
//安全校验域
|
||
data = binary.LittleEndian.AppendUint32(data, r.Sn)
|
||
data = binary.LittleEndian.AppendUint16(data, r.Sdl)
|
||
data = binary.LittleEndian.AppendUint32(data, r.Svc1)
|
||
data = binary.LittleEndian.AppendUint32(data, r.Svc2)
|
||
//用户数据包
|
||
data = append(data, r.Sad...)
|
||
//报文尾-CRC16
|
||
r.Crc16 = uint16(NewCrc(uint64(RsspCrc16GX), 17, data).Generate())
|
||
data = binary.LittleEndian.AppendUint16(data, r.Crc16)
|
||
//
|
||
return data
|
||
}
|
||
func (t *RsspRsd) Decode(buf []byte) error {
|
||
return nil
|
||
}
|
||
|
||
// RsspSse 时序校正请求包
|
||
type RsspSse struct {
|
||
RsspHead
|
||
//安全校验域-序列号(4Byte)
|
||
Sn uint32
|
||
//安全校验域-时序校正请求通道1(4Byte)
|
||
SeqEnq1 uint32
|
||
//安全校验域-时序校正请求通道2(4Byte)
|
||
SeqEnq2 uint32
|
||
//报文尾-CRC16(2Byte)
|
||
Crc16 uint16
|
||
}
|
||
|
||
// RsspSsr 时序校正应答包，用于回应SSE
|
||
type RsspSsr struct {
|
||
RsspHead
|
||
//安全校验域-应答方的序列号(4Byte)
|
||
SrSn uint32
|
||
//安全校验域-请求方的序列号(4Byte)
|
||
SeSn uint32
|
||
//安全校验域-时序初始化通道1(4Byte)
|
||
Tic1 uint32
|
||
//安全校验域-时序初始化通道2(4Byte)
|
||
Tic2 uint32
|
||
//安全校验域-数据版本号(1Byte)
|
||
Dvn byte
|
||
//报文尾-CRC16(2Byte)
|
||
Crc16 uint16
|
||
}
|
||
|
||
// //////////////////CRC循环冗余校验--移位寄存器///////////////////////////
|
||
|
||
const (
|
||
RsspCrc16GX uint32 = 0b1_0000_1000_0001_0001 //生成多项式 G(X)=X16+X11+X4+1
|
||
)
|
||
|
||
type crc struct {
|
||
//生成多项式，即二进制位数，如生成多项式X4+X3+1对应二进制11001共5位，生成的校验码长度为4
|
||
g uint64
|
||
//移位寄存器
|
||
reg uint64
|
||
//生成多项式长度、移位寄存器长度
|
||
gl int8
|
||
//消息数据
|
||
m []byte
|
||
}
|
||
|
||
// NewCrc CRC循环冗余校验
|
||
//
|
||
// g : 生成多项式
|
||
// gl : 生成多项式的长度即二进制位数
|
||
// m : 被校验的消息数据
|
||
func NewCrc(g uint64, gl int8, m []byte) *crc {
|
||
return &crc{g: g, gl: gl, m: m, reg: 0}
|
||
}
|
||
func (c *crc) Generate() uint64 {
|
||
return 0
|
||
}
|