[752e2a9] | 1 | import math
|
---|
| 2 | import os
|
---|
| 3 |
|
---|
| 4 | from ammosreader.AmmosGlobalFrameBody import AmmosGlobalFrameBody
|
---|
| 5 | from ammosreader.AmmosIFDataHeader import AmmosIFDataHeader
|
---|
| 6 | from ammosreader.AmmosExtendedIFDataHeader import AmmosExtendedIFDataHeader
|
---|
| 7 | from ammosreader.AmmosGlobalFrameHeader import AmmosGlobalFrameHeader
|
---|
| 8 | from ammosreader.AmmosSingleFrame import AmmosSingleFrame
|
---|
| 9 | from ammosreader.AmmosIFDataBlock import AmmosIFDataBlock
|
---|
| 10 | from ammosreader.AmmosContainer import AmmosContainer
|
---|
| 11 |
|
---|
| 12 |
|
---|
| 13 | class AmmosIFReader():
|
---|
| 14 |
|
---|
| 15 | def __init__(self, file_name):
|
---|
| 16 |
|
---|
| 17 | self.file_name = file_name
|
---|
| 18 | self.file = open(self.file_name, "rb")
|
---|
| 19 |
|
---|
| 20 | self.container = AmmosContainer(self.file_name, [])
|
---|
| 21 |
|
---|
| 22 | self.tags = []
|
---|
| 23 |
|
---|
| 24 | def add_tag(self, tag):
|
---|
| 25 | self.tags.append(tag)
|
---|
| 26 |
|
---|
| 27 | def read_all_frames_left(self):
|
---|
| 28 |
|
---|
| 29 | frames_read = 0
|
---|
| 30 |
|
---|
| 31 | while True:
|
---|
| 32 | # print("Reading single frame", frames_read, '...')
|
---|
| 33 | current_frame = self.read_next_single_frame()
|
---|
| 34 | if current_frame is not None:
|
---|
| 35 | frames_read += 1
|
---|
| 36 | self.container.add_frame(current_frame)
|
---|
| 37 | # if frames_read % 10000 == 0:
|
---|
| 38 | # print("#", end="")
|
---|
| 39 | else:
|
---|
| 40 | # print("Frame:", frames_read+1, " incomplete")
|
---|
| 41 | break
|
---|
| 42 |
|
---|
| 43 | # print(len(self.container.global_frames), "frames read")
|
---|
| 44 |
|
---|
| 45 | def read_next_global_frame_header(self):
|
---|
| 46 | bytes = self.file.read(24)
|
---|
| 47 | # print("Reading next global frame header")
|
---|
| 48 | if ((not bytes) or (len(bytes) < 24)):
|
---|
| 49 | # print("Can not read all 24 bytes of global frame header")
|
---|
| 50 | return None
|
---|
| 51 |
|
---|
| 52 | return AmmosGlobalFrameHeader.from_bytes(bytes)
|
---|
| 53 |
|
---|
| 54 | def read_next_global_frame_body_data_header(self):
|
---|
| 55 |
|
---|
| 56 | bytes = self.file.read(56)
|
---|
| 57 |
|
---|
| 58 | # print("\nReading global frame body standard data header\n")
|
---|
| 59 | if ((not bytes) or (len(bytes) < 56)):
|
---|
| 60 | # print("Can not read all 56 bytes of global frame body data header")
|
---|
| 61 | return None
|
---|
| 62 |
|
---|
| 63 | data_header = AmmosIFDataHeader.from_bytes(bytes)
|
---|
| 64 | # print("Data header", data_header)
|
---|
| 65 | return data_header
|
---|
| 66 |
|
---|
| 67 | def read_next_global_frame_body_extended_data_header(self):
|
---|
| 68 |
|
---|
| 69 | bytes = self.file.read(76)
|
---|
| 70 | # print("\nReading global frame body extended data header\n")
|
---|
| 71 |
|
---|
| 72 | if ((not bytes) or (len(bytes) < 76)):
|
---|
| 73 | # print("Can not read all ", 76, "bytes of global frame extended data header")
|
---|
| 74 | return None
|
---|
| 75 | extended_data_header = AmmosExtendedIFDataHeader.from_bytes(bytes)
|
---|
| 76 | # print("Extended data header", extended_data_header)
|
---|
| 77 | return extended_data_header
|
---|
| 78 |
|
---|
| 79 | def read_next_if_data_blocks(self, n, length):
|
---|
| 80 |
|
---|
| 81 | # FIXME: Describe the parameters better
|
---|
| 82 |
|
---|
| 83 | data_blocks = []
|
---|
| 84 |
|
---|
| 85 | block_length = 4 + length
|
---|
| 86 |
|
---|
| 87 | total = n*block_length
|
---|
| 88 |
|
---|
| 89 | byte_string = self.file.read(block_length)
|
---|
| 90 |
|
---|
| 91 | if len(byte_string) != total:
|
---|
| 92 | # print("Can not read all", total, "bytes of data body")
|
---|
| 93 | return None
|
---|
| 94 |
|
---|
| 95 | for i in range(0, n):
|
---|
| 96 | result = byte_string[i*block_length:(i*block_length+block_length)]
|
---|
| 97 | data_blocks.append(AmmosIFDataBlock(result[0:4], result[4:]))
|
---|
| 98 |
|
---|
| 99 | return data_blocks
|
---|
| 100 |
|
---|
| 101 | def read_next_global_frame_body(self, global_frame_header):
|
---|
| 102 |
|
---|
| 103 | if_data_header = None
|
---|
| 104 |
|
---|
| 105 | if global_frame_header.data_header_length == 56:
|
---|
| 106 | if_data_header = self.read_next_global_frame_body_data_header()
|
---|
| 107 | else:
|
---|
| 108 | if_data_header = self.read_next_global_frame_body_extended_data_header()
|
---|
| 109 |
|
---|
| 110 | if if_data_header is None:
|
---|
| 111 | # print("Data header missing")
|
---|
| 112 | return None
|
---|
| 113 |
|
---|
| 114 | if_data_body = self.read_next_if_data_blocks(if_data_header.block_count, if_data_header.block_length)
|
---|
| 115 |
|
---|
| 116 | if if_data_body is None:
|
---|
| 117 | # print("Data body missing")
|
---|
| 118 | return None
|
---|
| 119 |
|
---|
| 120 | return AmmosGlobalFrameBody(if_data_header, if_data_body)
|
---|
| 121 |
|
---|
| 122 | def read_next_single_frame(self):
|
---|
| 123 |
|
---|
| 124 | global_frame_header = self.read_next_global_frame_header()
|
---|
| 125 |
|
---|
| 126 | # print("\nReading next global frame header\n", global_frame_header)
|
---|
| 127 | # print("File pointer", self.file.tell())
|
---|
| 128 |
|
---|
| 129 | if global_frame_header is None:
|
---|
| 130 | # print("Global frame header missing")
|
---|
| 131 | return None
|
---|
| 132 |
|
---|
| 133 | if global_frame_header.data_header_length is None:
|
---|
| 134 | # print("Data header length empty")
|
---|
| 135 | return None
|
---|
| 136 |
|
---|
| 137 | if global_frame_header.frame_type == 2:
|
---|
| 138 |
|
---|
| 139 | global_frame_body = self.read_next_global_frame_body(global_frame_header)
|
---|
| 140 | if global_frame_body is None:
|
---|
| 141 | return None
|
---|
| 142 |
|
---|
| 143 | else:
|
---|
| 144 | # print("Unsupported frame type", global_frame_header.frame_type, "found")
|
---|
| 145 | return None
|
---|
| 146 |
|
---|
| 147 | return AmmosSingleFrame(global_frame_header, global_frame_body)
|
---|