RKUSBMaskromDriver: add support for using vendor idblock v1 images

Add support for using vendor idblock v1 image files, typically created
using the U-Boot mkimage tool.

Signed-off-by: Jonas Karlman <[email protected]>

Author: Kwiboo

labgrid/util/agents/rkusbmaskrom.py

@@ -161,6 +161,16 @@ def get_newidblock_entries(data, header, delay):
         offset += size
 
 
+def get_idblock_entries(data, header, delay):
+    offset, size = header.init_offset * 512, header.init_size * 512
+    yield 0x471, data[offset:offset + size], delay
+    if header.init_boot_size > header.init_size:
+        offset = (header.init_offset + header.init_size) * 512
+        size = (header.init_boot_size - header.init_size) * 512
+        if size != 524288:
+            yield 0x472, data[offset:offset + size], 0
+
+
 def parse_image_header(data):
     tag = int.from_bytes(data[:4], 'little')
     RKBootHeader = namedtuple('RKBootHeader', [
@@ -189,6 +199,15 @@ def parse_image_header(data):
                digest != data[1536:1536 + len(digest)]:
                 raise ValueError("Digest mismatch for header")
             return header, get_newidblock_entries
+    RKIDBlockHeader0 = namedtuple('RKIDBlockHeader0', [
+        'tag', 'disable_rc4', 'init_offset', 'init_size', 'init_boot_size',
+    ])
+    if tag == 0xfcdc8c3b:
+        keystream = rc4_prga(rc4_ksa(RK_RC4_KEY))
+        data = bytes(byte ^ next(keystream) for byte in data[:512])
+        header = RKIDBlockHeader0._make(unpack('<L4xLH492xHH2x', data[:512]))
+        if header.tag == 0x0ff0aa55 and header.init_size > 0:
+            return header, get_idblock_entries
     return None, None