-
Notifications
You must be signed in to change notification settings - Fork 1
/
writemultiplecoilsresponse.go
119 lines (108 loc) · 3.72 KB
/
writemultiplecoilsresponse.go
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
package packet
import (
"encoding/binary"
"errors"
)
// WriteMultipleCoilsResponseTCP is TCP Response for Write Multiple Coils (FC=15)
//
// Example packet: 0x01 0x38 0x00 0x00 0x00 0x06 0x11 0x0F 0x04 0x10 0x00 0x03
// 0x01 0x38 - transaction id (0,1)
// 0x00 0x00 - protocol id (2,3)
// 0x00 0x06 - number of bytes in the message (PDU = ProtocolDataUnit) to follow (4,5)
// 0x11 - unit id (6)
// 0x0F - function code (7)
// 0x04 0x10 - start address (8,9)
// 0x00 0x03 - count of coils written (10,11)
type WriteMultipleCoilsResponseTCP struct {
MBAPHeader
WriteMultipleCoilsResponse
}
// WriteMultipleCoilsResponseRTU is RTU Response for Write Multiple Coils (FC=15)
//
// Example packet: 0x11 0x0F 0x04 0x10 0x00 0x03 0x17 0xaf
// 0x11 - unit id (0)
// 0x0F - function code (1)
// 0x04 0x10 - start address (2,3)
// 0x00 0x03 - count of coils written (4,5)
// 0x17 0xaf - CRC16 (6,7)
type WriteMultipleCoilsResponseRTU struct {
WriteMultipleCoilsResponse
}
// WriteMultipleCoilsResponse is Response for Write Multiple Coils (FC=15)
type WriteMultipleCoilsResponse struct {
UnitID uint8
StartAddress uint16
CoilCount uint16
}
// Bytes returns WriteMultipleCoilsResponseTCP packet as bytes form
func (r WriteMultipleCoilsResponseTCP) Bytes() []byte {
length := uint16(6)
result := make([]byte, tcpMBAPHeaderLen+length)
r.MBAPHeader.bytes(result[0:6], length)
r.WriteMultipleCoilsResponse.bytes(result[6 : 6+length])
return result
}
// ParseWriteMultipleCoilsResponseTCP parses given bytes into ParseWriteMultipleCoilsResponseTCP
func ParseWriteMultipleCoilsResponseTCP(data []byte) (*WriteMultipleCoilsResponseTCP, error) {
dLen := len(data)
if dLen < 12 {
return nil, errors.New("received data length too short to be valid packet")
}
pduLen := binary.BigEndian.Uint16(data[4:6])
if dLen != 6+int(pduLen) {
return nil, errors.New("received data length does not match PDU len in packet")
}
return &WriteMultipleCoilsResponseTCP{
MBAPHeader: MBAPHeader{
TransactionID: binary.BigEndian.Uint16(data[0:2]),
ProtocolID: 0,
},
WriteMultipleCoilsResponse: WriteMultipleCoilsResponse{
UnitID: data[6],
StartAddress: binary.BigEndian.Uint16(data[8:10]),
CoilCount: binary.BigEndian.Uint16(data[10:12]),
},
}, nil
}
// Bytes returns WriteMultipleCoilsResponseRTU packet as bytes form
func (r WriteMultipleCoilsResponseRTU) Bytes() []byte {
result := make([]byte, 6+2)
bytes := r.WriteMultipleCoilsResponse.bytes(result)
crc := CRC16(bytes[:6])
result[6] = uint8(crc)
result[7] = uint8(crc >> 8)
return result
}
// ParseWriteMultipleCoilsResponseRTU parses given bytes into WriteMultipleCoilsResponseRTU
func ParseWriteMultipleCoilsResponseRTU(data []byte) (*WriteMultipleCoilsResponseRTU, error) {
dLen := len(data)
if dLen < 8 {
return nil, errors.New("received data length too short to be valid packet")
}
if dLen > 8 {
return nil, errors.New("received data length too long to be valid packet")
}
return &WriteMultipleCoilsResponseRTU{
WriteMultipleCoilsResponse: WriteMultipleCoilsResponse{
UnitID: data[0],
// data[1] function code
StartAddress: binary.BigEndian.Uint16(data[2:4]),
CoilCount: binary.BigEndian.Uint16(data[4:6]),
},
}, nil
}
// FunctionCode returns function code of this request
func (r WriteMultipleCoilsResponse) FunctionCode() uint8 {
return FunctionWriteMultipleCoils
}
// Bytes returns WriteMultipleCoilsResponse packet as bytes form
func (r WriteMultipleCoilsResponse) Bytes() []byte {
return r.bytes(make([]byte, 6))
}
func (r WriteMultipleCoilsResponse) bytes(bytes []byte) []byte {
bytes[0] = r.UnitID
bytes[1] = FunctionWriteMultipleCoils
binary.BigEndian.PutUint16(bytes[2:4], r.StartAddress)
binary.BigEndian.PutUint16(bytes[4:6], r.CoilCount)
return bytes
}