1""" 2 Copyright (c) 2024, The OpenThread Authors. 3 All rights reserved. 4 5 Redistribution and use in source and binary forms, with or without 6 modification, are permitted provided that the following conditions are met: 7 1. Redistributions of source code must retain the above copyright 8 notice, this list of conditions and the following disclaimer. 9 2. Redistributions in binary form must reproduce the above copyright 10 notice, this list of conditions and the following disclaimer in the 11 documentation and/or other materials provided with the distribution. 12 3. Neither the name of the copyright holder nor the 13 names of its contributors may be used to endorse or promote products 14 derived from this software without specific prior written permission. 15 16 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 17 AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE 20 LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 POSSIBILITY OF SUCH DAMAGE. 27""" 28 29from __future__ import annotations 30from typing import List 31 32 33class TLV(): 34 35 def __init__(self, type: int = None, value: bytes = None): 36 self.type: int = type 37 self.value: bytes = value 38 39 def __str__(self): 40 return f'TLV\n\tTYPE:\t0x{self.type:02x}\n\tVALUE:\t{self.value}' 41 42 @staticmethod 43 def parse_tlvs(data: bytes) -> List[TLV]: 44 res: List[TLV] = [] 45 while data: 46 next_tlv = TLV.from_bytes(data) 47 next_tlv_size = len(next_tlv.to_bytes()) 48 data = data[next_tlv_size:] 49 res.append(next_tlv) 50 return res 51 52 @staticmethod 53 def from_bytes(data: bytes) -> TLV: 54 res = TLV() 55 res.set_from_bytes(data) 56 return res 57 58 def set_from_bytes(self, data: bytes): 59 self.type = data[0] 60 header_len = 2 61 size_offset = 1 62 if data[1] == 0xFF: 63 header_len = 4 64 size_offset = 2 65 length = int.from_bytes(data[size_offset:header_len], byteorder='big') 66 self.value = data[header_len:header_len + length] 67 68 def to_bytes(self) -> bytes: 69 has_long_header = len(self.value) >= 254 70 header_len = 4 if has_long_header else 2 71 len_bytes = len(self.value).to_bytes(header_len // 2, byteorder='big') 72 type = self.type 73 if has_long_header: 74 type = type << 8 | 255 75 header = type.to_bytes(header_len // 2, byteorder='big') + len_bytes 76 return header + self.value 77