# -*- coding: utf-8 -*-

from . import devices
from .ansi import RESET, RED
from binascii import hexlify, unhexlify
from struct import pack, unpack
import sys

TLV_TYPES = {
    0x0001: "Checksum rectifier",
    0x0002: "Padding",
    0x0003: "Part number?",
    0x0005: "Copyright notice",
    0x0006: "Block Type 7 format definition",
    0x0007: "Binary descriptor",
    0x0008: "Binary Region 0C (boot.bin)",
    0x02bd: "Binary Region 0E (fw_all.bin)",
    0x0401: "Binary Component Firmware (SensorHub, ANT_BLE_BT, GPS, WiFi)",
    0x0505: "Binary Region 05 (main firmware)",
    0x0510: "Binary Region 10 (logo)",
    0x051b: "Binary Region 1b",
    0x052b: "Binary Region 2b",
    0x0533: "Binary Region 33 (dskimg)",
    0x0534: "Binary Region 34",
    0x0535: "Binary Region 35",
    0x0536: "Binary Region 36",
    0x0537: "Binary Region 37",
    0x0538: "Binary Region 38",
    0x0539: "Binary Region 39",
    0x053a: "Binary Region 3a",
    0x0549: "Binary Region 49",
    0x0555: "Binary Region 55 (fw)",
    0x0556: "Binary Region 56",
    0x0557: "Binary Region 57",
    0x0566: "Binary Region 66 (files.bin)",
    0x057f: "Binary Region 7f (resources)",
    0x0588: "Binary Region 88",
    0x0590: "Binary Region 90",
    0x0595: "Binary Region 95",
    0x0599: "Binary Region 99",
    0x059e: "Binary Region 9e (resources)",
    0x05a2: "Binary Region a2",
    0x05a4: "Binary Region a4",
    0x05a5: "Binary Region a5",
    0x05ab: "Binary Region ab",
    0x05f5: "Binary Region f5",
    0x05f9: "Binary Region f9",
    0x05fa: "Binary Region fa",
    0x05fb: "Binary Region fb",
    0x05fc: "Binary Region fc",
    0x05fd: "Binary Region fd",
    0x05fe: "Binary Region fe",
    0x07d1: "Binary 07d1",
    0x07d2: "Binary 07d2",
    0x07d3: "Binary 07d3",
    0xffff: "EOF marker",
}

BINARY_TLVS = [ 0x0008, 0x02bd, 0x0505, 0x0510, 0x051b, 0x052b, 0x0533, 0x0534, 0x0535, 0x0536,
                0x0537, 0x0538, 0x0539, 0x053a, 0x0549, 0x0555, 0x0556, 0x0557, 0x0566, 0x057f,
                0x0588, 0x0590, 0x0595, 0x0599, 0x059e, 0x05a2, 0x05a4, 0x05a5, 0x05ab, 0x05f5,
                0x05f9, 0x05fa, 0x05fb, 0x05fc, 0x05fd, 0x05fe, 0x07d1, 0x07d2, 0x07d3 ]

class TLV:
    def __init__(self, type_id: int, expected_length: int, value=None, offset: int=None):
        self.type_id = type_id
        self.is_binary = False
        self.offset = offset
        self.comment = TLV_TYPES.get(type_id, RED + "Type {:04x} / {:d}".format(type_id, type_id) + RESET)
        self.length = expected_length
        self.value = None
        self.is_parsed = False
        if value is not None:
            self.value = bytes(value)

    @staticmethod
    def factory(type_id: int, length: int = None, offset: int = None):
        if type_id == 0x0001:
            new_tlv = TLV1(type_id, length)
        elif type_id == 0x0002:
            new_tlv = TLV2(type_id, length)
        elif type_id == 0x0005:
            new_tlv = TLV5(type_id, length)
        elif type_id == 0x0006:
            new_tlv = TLV6(type_id, length)
        elif type_id == 0x0007:
            new_tlv = TLV7(type_id, length)
        elif type_id == 0x0401:
            new_tlv = TLVbinary0401(type_id, length)
            new_tlv.is_binary = True
        elif type_id in BINARY_TLVS:
            new_tlv = TLVbinary(type_id, length)
            new_tlv.is_binary = True
        else:
            new_tlv = TLV(type_id, length)
        new_tlv.offset = offset
        return new_tlv

    def __str__(self):
        plural = ""
        if self.length != 1:
            plural = "s"
        offset = ""
        if self.offset:
            offset = " at 0x{:x}".format(self.offset)
        lenstr = ""
        if self.length:
            lenstr = ", {:d} Byte{}".format(self.length, plural)
        return "TLV Type {:04x}{}{} - {}".format(self.type_id, offset, lenstr, self.comment)

    def set_value(self, new_value: bytes):
        self.value = new_value

    def get_actual_length(self):
        if self.value is None:
            return 0
        return len(self.value)

    def get_record_length(self):
        # Length including record definition
        return self.get_actual_length() + 4

    def get_value(self):
        return self.value

    def get_header(self):
        header = pack("HH", self.type_id, self.get_actual_length())
        return header

    def get(self):
        header = self.get_header()
        if self.value is None:
            return header
        return header + self.value

    def dump(self):
        """Should return a list of key-value-comment tuples so the object can be recreated using create_from_dump() later."""
        data = []
        data.append(("type", "0x{:04x}".format(self.type_id), self.comment))
        data.append(("length", self.get_actual_length(), None))
        if self.value is not None:
            hexstr = hexlify(self.value).decode("utf-8")
            hexstr = " ".join(hexstr[i:i+2] for i in range(0, len(hexstr), 2))
            data.append(("value", hexstr, None))
        return data

    def load_dump(self, values):
        for (k, v) in values:
            if k == "value":
                self.value = unhexlify("".join(v.split(" ")))
                self.length = len(self.value)

    @staticmethod
    def create_from_dump(values):
        """Use data exported with dump() to recreate object."""
        tlv = None
        for (k, v) in values:
            if k == "type":
                type_id = int(v, 0)
        tlv = TLV.factory(type_id)
        tlv.load_dump(values)
        return tlv

class TLV1(TLV):
    def dump(self):
        data = []
        data.append(("type", "0x{:04x}".format(self.type_id), self.comment))
        return data

    def load_dump(self, values):
        # Will be calculated in a final pass
        self.value = 0x00
        self.length = 1

class TLV2(TLV):
    def dump(self):
        data = []
        data.append(("type", "0x{:04x}".format(self.type_id), self.comment))
        data.append(("length", self.get_actual_length(), "Length of padding block"))
        return data

    def load_dump(self, values):
        for (k, v) in values:
            if k == "length":
                self.value = b"\x00" * int(v)
                self.length = len(self.value)
                break

class TLV5(TLV):
    def dump(self):
        data = []
        data.append(("type", "0x{:04x}".format(self.type_id), self.comment))
        data.append(("length", self.get_actual_length(), None))
        data.append(("text", self.value.decode("utf-8"), None))
        return data

    def load_dump(self, values):
        for (k, v) in values:
            if k == "text":
                self.value = v.encode("utf-8")
            elif k == "length":
                self.length = int(v)
        if len(self.value) != self.length:
            print(RED + "WARNING: Imported copyright text doesn't match supposed length." + RESET, file=sys.stderr)
            self.length = len(self.value)

class TLV6(TLV):
    """
    Describes following TLV7:
    http://www.gpspassion.com/forumsen/topic.asp?TOPIC_ID=137838&whichpage=12
    """

    # Field ids in Type 6 payloads (describe Type 7 data format)
    # First nibble might be data type: 0 = B, 1 = H, 2 = L
    FIELD_TYPES = {
        0x000a: ["B", "XOR flag/value"],
        0x000b: ["B", "Reset/Downgrade flag"],
        0x000c: ["B", "Field 000c"],
        0x0020: ["B", "Field 0020"],
        0x1009: ["H", "Device hw_id"],
        0x100a: ["H", "Block type"],
        0x100c: ["H", "Field 100c"],
        0x100d: ["H", "Firmware version"],
        0x100e: ["H", "Field 100e"],
        0x100f: ["H", "Field 100f"],
        0x1010: ["H", "Field 1010"],
        0x1011: ["H", "Field 1011"],
        0x1012: ["H", "Field 1012"],
        0x1013: ["H", "Field 1013"],
        0x1014: ["H", "Field 1014"],
        0x1015: ["H", "Field 1015"],
        0x1016: ["H", "Field 1016 (WiFi fw)"],
        0x2015: ["L", "Binary length"],
        0x2017: ["L", "Field 2017"],
        0x2018: ["L", "Field 2018"],
        0x2019: ["L", "Field 2019"],
        0x201a: ["L", "Field 201a"],
        0x4007: ["31s", "Field 4007"],   # WTF? 31 Bytes long
        0x5003: ["", "End of definition marker"],
    }

    def __init__(self, type_id: int, expected_length: int, value=None, offset: int=None):
        super().__init__(type_id, expected_length, value, offset)
        self.fids = []
        self.format = []
        self.fields = []

    def add_fid(self, fid: int):
        fdef = self.FIELD_TYPES[fid]
        self.fids.append(fid)
        self.format.append(fdef[0])
        self.fields.append(fdef[1])

    def parse(self):
        if self.is_parsed:
            # already parsed
            return
        if len(self.value) % 2 != 0:
            raise Exception(RED + "Invalid TLV6 payload length!" + RESET)

        self.fids = []
        self.format = []
        self.fields = []
        for i in range(0, len(self.value), 2):
            fid = unpack("<H", self.value[i:i+2])[0]
            self.add_fid(fid)

        self.is_parsed = True

    def __str__(self):
        txt = super().__str__()
        if not self.is_parsed:
            self.parse()
        txt += "\n  - Field list:"
        for i, fid in enumerate(self.fids):
            #txt += "\n  - Field {:d}: {:04x} - {}".format(i+1, fid, self.fields[i])
            txt += " {:04x}".format(fid)
        return txt

    def dump(self):
        # Dump nothing as important info will be chained in binary dump
        return []

    def load_dump(self, values):
        self.value = b""
        for (k, v) in values:
            if k == "from_file":
                continue
            elif k[0:2] != "0x":
                continue
            fid = int(k, 0)
            self.value += pack("<H", fid)
        self.value += pack("<H", 0x5003)
        self.length = len(self.value)

class TLV7(TLV):
    def __init__(self, type_id: int, expected_length: int, value=None, offset: int=None):
        super().__init__(type_id, expected_length, value, offset)
        self.tlv6 = None
        self.binary_type_id = None
        self.attr = []

    def set_tlv6(self, tlv6: TLV6):
        self.tlv6 = tlv6

    def parse(self):
        if self.is_parsed:
            # already parsed
            return
        if not self.tlv6.is_parsed:
            # Make sure we have the structure analysed
            self.tlv6.parse()
        self.attr = []
        #print("Got {} Bytes.".format(len(self.value)))
        #print("Format: {}".format(self.tlv6.format))
        #print(repr(self.value))
        values = unpack("<" + "".join(self.tlv6.format), self.value)
        for i, v in enumerate(values):
            fid = self.tlv6.fids[i]
            self.attr.append((fid, v))
            if fid == 0x100a:
                self.binary_type_id = v
        self.is_parsed = True

    def __str__(self):
        txt = super().__str__()
        if not self.is_parsed:
            self.parse()
        for i, pair in enumerate(self.attr):
            fdesc = self.tlv6.fields[i]
            (fid, v) = pair
            if fid == 0x1009:
                txt += "\n  - Field {:d} ({:04x}): {:>20}: 0x{:04x} / {:d} ({})".format(i+1, fid, fdesc, v, v, devices.get_name(v, 0, RED + "Unknown device" + RESET))
            elif fid == 0x2015:
                txt += "\n  - Field {:d} ({:04x}): {:>20}: {} Bytes".format(i+1, fid, fdesc, v)
            elif fid == 0x4007:
                txt += "\n  - Field {:d} ({:04x}): {:>20}: {}".format(i+1, fid, fdesc, hexlify(v).decode("utf-8"))
            else:
                txt += "\n  - Field {:d} ({:04x}): {:>20}: 0x{:04x} / {:d}".format(i+1, fid, fdesc, v, v)
        return txt

    def set_binary_length(self, new_length):
        self.tlv6.parse()
        values = unpack("<" + "".join(self.tlv6.format), self.value)
        new_values = []
        for i, v in enumerate(values):
            fid = self.tlv6.fids[i]
            if fid == 0x2015:
                new_values.append(new_length)
            else:
                new_values.append(v)
        self.value = pack("<" + "".join(self.tlv6.format), *new_values)
        self.is_parsed = False

    def dump(self):
        # Dump nothing as important info will be chained in binary dump
        return []

    def load_dump(self, values):
        self.value = b""
        new_values = []
        for (k, v) in values:
            if k == "from_file":
                continue
            elif k[0:2] != "0x":
                continue
            if v[0:2] == "0x":
                numval = int(v, 0)
            else:
                numval = unhexlify(v)
            new_values.append(numval)
        if not self.tlv6.is_parsed:
            # Make sure we have the structure analysed (need format attr)
            self.tlv6.parse()
        self.value = pack("<" + "".join(self.tlv6.format), *new_values)
        self.length = len(self.value)

class TLVbinary(TLV):
    def __init__(self, type_id: int, expected_length: int, value=None, offset: int=None):
        super().__init__(type_id, expected_length, value, offset)
        self.tlv7 = None

    def set_tlv7(self, tlv7: TLV7):
        self.tlv7 = tlv7

    def dump(self):
        data = []
        # type is given in fields list from TLV7 already
        if not self.tlv7.is_parsed:
            self.tlv7.parse()
        for i, pair in enumerate(self.tlv7.attr):
            fdesc = self.tlv7.tlv6.fields[i]
            valtype = self.tlv7.tlv6.format[i]
            (fid, v) = pair
            if valtype == "B":
                valstr = "0x{:02x}".format(v)
            elif valtype == "H":
                valstr = "0x{:04x}".format(v)
            elif valtype == "Q":
                valstr = "0x{:08x}".format(v)
            elif valtype == "31s":
                valstr = hexlify(v).decode("utf-8")
            else:
                valstr = "0x{:08x}".format(v)
            data.append(("0x{:04x}".format(fid), valstr, fdesc))
        return data

class TLVbinary0401(TLVbinary):
    def __str__(self):
        txt = super().__str__()
        skuprobe = self.value[10:14]
        if skuprobe == b"006B":
            version = unpack("<H", self.value[4:6])[0]
            sku = self.value[10:20].decode("utf-8")
            hwid = int(sku[4:8])
            txt += "\n  -     SKU: {}-{}-{}".format(sku[0:3], sku[3:8], sku[8:10])
            txt += "\n  -   hw_id: 0x{:04x} / {:d} ({})".format(hwid, hwid, devices.get_name(hwid, 0, RED + "Unknown device" + RESET))
            txt += "\n  - Version: 0x{:04x} / {:d}".format(version, version)
        elif skuprobe == b"SW_I":
            swistring = self.value[10:20].decode("utf-8")
            payloadprobe = self.value[0x40:0x42]
            txt += "\n - Type: Software Inventory ({}) - actual payload starts at 0x40".format(swistring)
            if payloadprobe == b"PK":
                txt += "\n         Probably ZIP archive"
            elif payloadprobe == b"Fi":
                txt += "\n         Probably CSV file"
        else:
            txt += "\n  - Unknown header format (0x{})".format(hexlify(skuprobe).decode("utf-8"))
        #if not self.is_parsed:
        #    self.parse()
        return txt