#!/usr/bin/env python2 # SPDX-License-Identifier: BSD-2-Clause import struct import sys from io import SEEK_SET, SEEK_END class IDBTool: def __init__(self): print "Initialize IDBTool" def p_rc4(self, buf, length): key = (124,78,3,4,85,5,9,7,45,44,123,56,23,13,23,17) K = key * 16 S = [i for i in range(256)] j = 0 for i in range(256): j = (j + S[i] + K[i]) % 256 temp = S[i]; S[i] = S[j]; S[j] = temp; i = j = k = 0 for x in range(length): i = (i+1) % 256 j = (j + S[i]) % 256 temp = S[i]; S[i] = S[j]; S[j] = temp k = (S[i] + S[j]) % 256 buf[x] = struct.pack('B', ord(buf[x]) ^ S[k]) def makeIDB(self, chip, from_file, to_file, rc4_flag = False, align_flag = False): try: fin = open(from_file, 'rb') except: sys.exit("Failed to open file : " + from_file) try: fin.seek(0, SEEK_END) if (fin.tell() > 4 * 1024 * 1024): sys.exit("Input file is more than 4MB") fin.seek(0) data = fin.read() finally: fin.close() data_len = len(data) SECTOR_SIZE = 512 PAGE_ALIGN = 4 sectors = (data_len + 4 - 1) / SECTOR_SIZE + 1 pages = (sectors - 1) / PAGE_ALIGN + 1 sectors = pages * PAGE_ALIGN; buf = [B'\0'] * sectors * SECTOR_SIZE buf[:4] = chip buf[4 : 4+data_len] = data idblock = [B'\0'] * 4 * SECTOR_SIZE blank = [B'\0'] * 4 * SECTOR_SIZE idblock[:4] = ['\x55', '\xAA', '\xF0', '\x0F'] if (not rc4_flag): idblock[8:12] = struct.pack("<I", 1) else: for i in range(sectors): list_tmp = buf[SECTOR_SIZE*i : SECTOR_SIZE*(i+1)] self.p_rc4(list_tmp, SECTOR_SIZE) buf[SECTOR_SIZE*i : SECTOR_SIZE*(i+1)] = list_tmp idblock[12:16] = struct.pack("<HH", 4, 4); idblock[506:510] = struct.pack("<HH", sectors, sectors); self.p_rc4(idblock, SECTOR_SIZE) try: fout = open(to_file, "wb+") except: sys.exit("Failed to open output file : " + to_file) try: if (align_flag): fout.write(''.join(idblock)) fout.write(''.join(blank)) for s in xrange(0, sectors * SECTOR_SIZE, PAGE_ALIGN * SECTOR_SIZE): fout.write(''.join(buf[s : s + PAGE_ALIGN * SECTOR_SIZE])) fout.write(''.join(blank)) else: fout.write(''.join(idblock)) fout.write(''.join(buf)) fout.flush() except: sys.exit("Failed to write data to : " + to_file) finally: fout.close() print "DONE" def usage(): print "Usage: make_idb.py [--chip=RKXX] [--enable-rc4] [--enable-align] [--to=out] --from=in" print " --chip: default is RK32" if __name__ == '__main__': rc4_flag = align_flag = False to_file = "IDBlock.bin" chip = "RK32" for para in sys.argv[1:]: if (para == "--enable-rc4"): rc4_flag = True elif (para == "--enable-align"): align_flag = True elif (para.startswith("--to=")): to_file = para.split('=')[1] elif (para.startswith("--from=")): from_file = para.split('=')[1] elif (para.startswith("--chip=")): chip = para.split('=')[1] elif (para == "--help" or para == "-h"): usage() sys.exit() else: usage() sys.exit() if ('from_file' not in vars() or to_file == ''): usage() sys.exit() idbtool = IDBTool() idbtool.makeIDB(chip, from_file, to_file, rc4_flag, align_flag)