-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathuser_data.py
More file actions
213 lines (181 loc) · 6.77 KB
/
user_data.py
File metadata and controls
213 lines (181 loc) · 6.77 KB
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
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
import struct
from ..enums import (
DataTransportSize,
MessageType,
SubfunctionCode,
TransmissionType,
UserdataFunction,
UserdataLastPDU,
UserdataMethod,
)
from .data_item import DataItem
from .packet import S7Packet
class UserDataRequestParameter:
HEAD = b"\x00\x01\x12"
def __init__(
self,
function_group: UserdataFunction,
subfunction: SubfunctionCode,
method: UserdataMethod = UserdataMethod.REQUEST,
type: TransmissionType = TransmissionType.REQUEST,
sequence_number: int = 0,
length: int = 4,
):
self.length = length
self.method = method
self.type = type # 4 bits
self.function_group = function_group # 4 bits
self.subfunction = subfunction
self.sequence_number = sequence_number
self.data_length = None
def serialize(self) -> bytes:
type_funcgroup = self.type << 4 | self.function_group
param = struct.pack("BBBBB", self.length, self.method, type_funcgroup, self.subfunction, self.sequence_number)
return self.HEAD + param
class UserDataContinuationParameter:
"""Parameter for requesting next data unit in multi-packet Userdata response."""
HEAD = b"\x00\x01\x12"
def __init__(
self,
function_group: UserdataFunction,
subfunction: SubfunctionCode,
sequence_number: int,
):
self.length = 8 # Extended parameter length
self.method = UserdataMethod.RESPONSE # Uses RESPONSE method for continuation
self.type = TransmissionType.REQUEST
self.function_group = function_group
self.subfunction = subfunction
self.sequence_number = sequence_number
self.data_unit_reference = 0
self.last_data_unit = UserdataLastPDU.YES
self.error_code = 0
def serialize(self) -> bytes:
type_funcgroup = self.type << 4 | self.function_group
param = struct.pack(
"!BBBBBBBH",
self.length,
self.method,
type_funcgroup,
self.subfunction,
self.sequence_number,
self.data_unit_reference,
self.last_data_unit,
self.error_code,
)
return self.HEAD + param
class UserDataResponseParameter(UserDataRequestParameter):
def __init__(
self,
data_unit_reference: int,
last_data_unit: UserdataLastPDU,
error_code: int,
method: UserdataMethod,
type: TransmissionType,
function_group: UserdataFunction,
subfunction: SubfunctionCode,
sequence_number: int = 0,
length: int = 4,
):
super().__init__(
method=method,
type=type,
function_group=function_group,
subfunction=subfunction,
sequence_number=sequence_number,
length=length,
)
self.data_unit_reference = data_unit_reference
self.last_data_unit = last_data_unit
self.error_code = error_code
@classmethod
def parse(cls, packet: bytes) -> "UserDataResponseParameter":
_, length = struct.unpack_from("3sB", packet)
(
method,
type_funcgroup,
subfunction,
sequence_number,
data_unit_reference,
last_data_unit,
error_code,
) = struct.unpack_from("BBBBBBH", packet, offset=4)
type_ = type_funcgroup >> 4
function_group = type_funcgroup & 0x0F
return cls(
length=length,
method=method,
type=type_,
function_group=function_group,
subfunction=subfunction,
sequence_number=sequence_number,
data_unit_reference=data_unit_reference,
last_data_unit=UserdataLastPDU(last_data_unit),
error_code=error_code,
)
class UserDataRequest(S7Packet):
MESSAGE_TYPE = MessageType.Userdata
def __init__(self, parameter: UserDataRequestParameter, data: DataItem) -> None:
self.parameter = parameter
self.data = data
@classmethod
def create(
cls,
function_group: UserdataFunction,
subfunction: SubfunctionCode,
method: UserdataMethod = UserdataMethod.REQUEST,
type: TransmissionType = TransmissionType.REQUEST,
sequence_number: int = 0,
length: int = 4,
transport_size: DataTransportSize = DataTransportSize.OCTET,
return_code: int = 0xFF,
data: bytes = b"",
) -> "UserDataRequest":
parameter = UserDataRequestParameter(
function_group=function_group,
subfunction=subfunction,
method=method,
type=type,
sequence_number=sequence_number,
length=length,
)
data_item = DataItem(transport_size=transport_size, return_code=return_code, data_length=len(data), data=data)
return cls(parameter=parameter, data=data_item)
def serialize_parameter(self) -> bytes:
return self.parameter.serialize()
def serialize_data(self) -> bytes:
return bytes(self.data.serialize())
class UserDataResponse(S7Packet):
PARAMETER_LENGTH: int = 12
def __init__(self, parameter: UserDataResponseParameter, data: DataItem) -> None:
self.parameter = parameter
self.data = data
@classmethod
def parse(cls, packet: bytes) -> "UserDataResponse":
parameter = UserDataResponseParameter.parse(packet)
data = DataItem.parse(packet[cls.PARAMETER_LENGTH :])
return cls(parameter=parameter, data=data)
def serialize_parameter(self) -> bytes:
return self.parameter.serialize()
def serialize_data(self) -> bytes:
return bytes(self.data.serialize())
class UserDataContinuationRequest(S7Packet):
"""Request for next data unit in multi-packet Userdata response."""
MESSAGE_TYPE = MessageType.Userdata
def __init__(self, parameter: UserDataContinuationParameter) -> None:
self.parameter = parameter
# Minimal data: return_code=0x0a, transport_size=0, data_length=0
self.data = DataItem(transport_size=DataTransportSize.NULL, data_length=0, return_code=0x0A)
@classmethod
def from_response(cls, response: "UserDataResponse") -> "UserDataContinuationRequest":
"""Create continuation request from a Userdata response that has more data."""
parameter = UserDataContinuationParameter(
function_group=response.parameter.function_group,
subfunction=response.parameter.subfunction,
sequence_number=response.parameter.sequence_number,
)
return cls(parameter=parameter)
def serialize_parameter(self) -> bytes:
return self.parameter.serialize()
def serialize_data(self) -> bytes:
return self.data.serialize()