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
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
|
import socket
import struct
from enum import Enum
from atf_python.sys.netlink.utils import align4
from atf_python.sys.netlink.utils import enum_or_int
class NlAttr(object):
HDR_LEN = 4 # sizeof(struct nlattr)
def __init__(self, nla_type, data):
if isinstance(nla_type, Enum):
self._nla_type = nla_type.value
self._enum = nla_type
else:
self._nla_type = nla_type
self._enum = None
self.nla_list = []
self._data = data
@property
def nla_type(self):
return self._nla_type & 0x3FFF
@property
def nla_len(self):
return len(self._data) + 4
def add_nla(self, nla):
self.nla_list.append(nla)
def print_attr(self, prepend=""):
if self._enum is not None:
type_str = self._enum.name
else:
type_str = "nla#{}".format(self.nla_type)
print(
"{}len={} type={}({}){}".format(
prepend, self.nla_len, type_str, self.nla_type, self._print_attr_value()
)
)
@staticmethod
def _validate(data):
if len(data) < 4:
raise ValueError("attribute too short")
nla_len, nla_type = struct.unpack("@HH", data[:4])
if nla_len > len(data):
raise ValueError("attribute length too big")
if nla_len < 4:
raise ValueError("attribute length too short")
@classmethod
def _parse(cls, data):
nla_len, nla_type = struct.unpack("@HH", data[:4])
return cls(nla_type, data[4:])
@classmethod
def from_bytes(cls, data, attr_type_enum=None):
cls._validate(data)
attr = cls._parse(data)
attr._enum = attr_type_enum
return attr
def _to_bytes(self, data: bytes):
ret = data
if align4(len(ret)) != len(ret):
ret = data + bytes(align4(len(ret)) - len(ret))
return struct.pack("@HH", len(data) + 4, self._nla_type) + ret
def __bytes__(self):
return self._to_bytes(self._data)
def _print_attr_value(self):
return " " + " ".join(["x{:02X}".format(b) for b in self._data])
class NlAttrNested(NlAttr):
def __init__(self, nla_type, val):
super().__init__(nla_type, b"")
self.nla_list = val
def get_nla(self, nla_type):
nla_type_raw = enum_or_int(nla_type)
for nla in self.nla_list:
if nla.nla_type == nla_type_raw:
return nla
return None
@property
def nla_len(self):
return align4(len(b"".join([bytes(nla) for nla in self.nla_list]))) + 4
def print_attr(self, prepend=""):
if self._enum is not None:
type_str = self._enum.name
else:
type_str = "nla#{}".format(self.nla_type)
print(
"{}len={} type={}({}) {{".format(
prepend, self.nla_len, type_str, self.nla_type
)
)
for nla in self.nla_list:
nla.print_attr(prepend + " ")
print("{}}}".format(prepend))
def __bytes__(self):
return self._to_bytes(b"".join([bytes(nla) for nla in self.nla_list]))
class NlAttrU32(NlAttr):
def __init__(self, nla_type, val):
self.u32 = enum_or_int(val)
super().__init__(nla_type, b"")
@property
def nla_len(self):
return 8
def _print_attr_value(self):
return " val={}".format(self.u32)
@staticmethod
def _validate(data):
assert len(data) == 8
nla_len, nla_type = struct.unpack("@HH", data[:4])
assert nla_len == 8
@classmethod
def _parse(cls, data):
nla_len, nla_type, val = struct.unpack("@HHI", data)
return cls(nla_type, val)
def __bytes__(self):
return self._to_bytes(struct.pack("@I", self.u32))
class NlAttrS32(NlAttr):
def __init__(self, nla_type, val):
self.s32 = enum_or_int(val)
super().__init__(nla_type, b"")
@property
def nla_len(self):
return 8
def _print_attr_value(self):
return " val={}".format(self.s32)
@staticmethod
def _validate(data):
assert len(data) == 8
nla_len, nla_type = struct.unpack("@HH", data[:4])
assert nla_len == 8
@classmethod
def _parse(cls, data):
nla_len, nla_type, val = struct.unpack("@HHi", data)
return cls(nla_type, val)
def __bytes__(self):
return self._to_bytes(struct.pack("@i", self.s32))
class NlAttrU16(NlAttr):
def __init__(self, nla_type, val):
self.u16 = enum_or_int(val)
super().__init__(nla_type, b"")
@property
def nla_len(self):
return 6
def _print_attr_value(self):
return " val={}".format(self.u16)
@staticmethod
def _validate(data):
assert len(data) == 6
nla_len, nla_type = struct.unpack("@HH", data[:4])
assert nla_len == 6
@classmethod
def _parse(cls, data):
nla_len, nla_type, val = struct.unpack("@HHH", data)
return cls(nla_type, val)
def __bytes__(self):
return self._to_bytes(struct.pack("@H", self.u16))
class NlAttrU8(NlAttr):
def __init__(self, nla_type, val):
self.u8 = enum_or_int(val)
super().__init__(nla_type, b"")
@property
def nla_len(self):
return 5
def _print_attr_value(self):
return " val={}".format(self.u8)
@staticmethod
def _validate(data):
assert len(data) == 5
nla_len, nla_type = struct.unpack("@HH", data[:4])
assert nla_len == 5
@classmethod
def _parse(cls, data):
nla_len, nla_type, val = struct.unpack("@HHB", data)
return cls(nla_type, val)
def __bytes__(self):
return self._to_bytes(struct.pack("@B", self.u8))
class NlAttrIp(NlAttr):
def __init__(self, nla_type, addr: str):
super().__init__(nla_type, b"")
self.addr = addr
if ":" in self.addr:
self.family = socket.AF_INET6
else:
self.family = socket.AF_INET
@staticmethod
def _validate(data):
nla_len, nla_type = struct.unpack("@HH", data[:4])
data_len = nla_len - 4
if data_len != 4 and data_len != 16:
raise ValueError(
"Error validating attr {}: nla_len is not valid".format( # noqa: E501
nla_type
)
)
@property
def nla_len(self):
if self.family == socket.AF_INET6:
return 20
else:
return 8
return align4(len(self._data)) + 4
@classmethod
def _parse(cls, data):
nla_len, nla_type = struct.unpack("@HH", data[:4])
data_len = len(data) - 4
if data_len == 4:
addr = socket.inet_ntop(socket.AF_INET, data[4:8])
else:
addr = socket.inet_ntop(socket.AF_INET6, data[4:20])
return cls(nla_type, addr)
def __bytes__(self):
return self._to_bytes(socket.inet_pton(self.family, self.addr))
def _print_attr_value(self):
return " addr={}".format(self.addr)
class NlAttrIp4(NlAttrIp):
def __init__(self, nla_type, addr: str):
super().__init__(nla_type, addr)
assert self.family == socket.AF_INET
class NlAttrIp6(NlAttrIp):
def __init__(self, nla_type, addr: str):
super().__init__(nla_type, addr)
assert self.family == socket.AF_INET6
class NlAttrStr(NlAttr):
def __init__(self, nla_type, text):
super().__init__(nla_type, b"")
self.text = text
@staticmethod
def _validate(data):
NlAttr._validate(data)
try:
data[4:].decode("utf-8")
except Exception as e:
raise ValueError("wrong utf-8 string: {}".format(e))
@property
def nla_len(self):
return len(self.text) + 5
@classmethod
def _parse(cls, data):
text = data[4:-1].decode("utf-8")
nla_len, nla_type = struct.unpack("@HH", data[:4])
return cls(nla_type, text)
def __bytes__(self):
return self._to_bytes(bytes(self.text, encoding="utf-8") + bytes(1))
def _print_attr_value(self):
return ' val="{}"'.format(self.text)
class NlAttrStrn(NlAttr):
def __init__(self, nla_type, text):
super().__init__(nla_type, b"")
self.text = text
@staticmethod
def _validate(data):
NlAttr._validate(data)
try:
data[4:].decode("utf-8")
except Exception as e:
raise ValueError("wrong utf-8 string: {}".format(e))
@property
def nla_len(self):
return len(self.text) + 4
@classmethod
def _parse(cls, data):
text = data[4:].decode("utf-8")
nla_len, nla_type = struct.unpack("@HH", data[:4])
return cls(nla_type, text)
def __bytes__(self):
return self._to_bytes(bytes(self.text, encoding="utf-8"))
def _print_attr_value(self):
return ' val="{}"'.format(self.text)
|
