Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 1 | #!/usr/bin/env python |
| 2 | # Fill in checksum/size of an option rom, and pad it to proper length. |
| 3 | # |
| 4 | # Copyright (C) 2009 Kevin O'Connor <kevin@koconnor.net> |
| 5 | # |
| 6 | # This file may be distributed under the terms of the GNU GPLv3 license. |
| 7 | |
Kevin O'Connor | e51488c | 2014-05-22 16:59:16 -0400 | [diff] [blame] | 8 | import sys, struct |
Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 9 | |
| 10 | def alignpos(pos, alignbytes): |
| 11 | mask = alignbytes - 1 |
| 12 | return (pos + mask) & ~mask |
| 13 | |
| 14 | def checksum(data): |
Kevin O'Connor | e51488c | 2014-05-22 16:59:16 -0400 | [diff] [blame] | 15 | if (sys.version_info > (3, 0)): |
| 16 | cksum = sum(data) |
| 17 | else: |
| 18 | cksum = sum(map(ord, data)) |
| 19 | return struct.pack('<B', (0x100 - cksum) & 0xff) |
Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 20 | |
| 21 | def main(): |
| 22 | inname = sys.argv[1] |
| 23 | outname = sys.argv[2] |
| 24 | |
| 25 | # Read data in |
| 26 | f = open(inname, 'rb') |
| 27 | data = f.read() |
Kevin O'Connor | f31bff1 | 2013-05-20 21:39:56 -0400 | [diff] [blame] | 28 | f.close() |
Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 29 | count = len(data) |
| 30 | |
| 31 | # Pad to a 512 byte boundary |
Kevin O'Connor | 6a62e0c | 2021-12-19 01:31:09 -0500 | [diff] [blame^] | 32 | data += b"\0" * (alignpos(count, 512) - count) |
Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 33 | count = len(data) |
| 34 | |
Julian Pidancet | 65cfaa2 | 2011-12-19 05:07:57 +0000 | [diff] [blame] | 35 | # Check if a pci header is present |
| 36 | pcidata = ord(data[24:25]) + (ord(data[25:26]) << 8) |
| 37 | if pcidata != 0: |
Kevin O'Connor | e51488c | 2014-05-22 16:59:16 -0400 | [diff] [blame] | 38 | blocks = struct.pack('<H', int(count/512)) |
| 39 | data = data[:pcidata + 16] + blocks + data[pcidata + 18:] |
Julian Pidancet | 65cfaa2 | 2011-12-19 05:07:57 +0000 | [diff] [blame] | 40 | |
Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 41 | # Fill in size field; clear checksum field |
Kevin O'Connor | e51488c | 2014-05-22 16:59:16 -0400 | [diff] [blame] | 42 | blocks = struct.pack('<B', int(count/512)) |
Kevin O'Connor | 6a62e0c | 2021-12-19 01:31:09 -0500 | [diff] [blame^] | 43 | data = data[:2] + blocks + data[3:6] + b"\0" + data[7:] |
Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 44 | |
| 45 | # Checksum rom |
Kevin O'Connor | e51488c | 2014-05-22 16:59:16 -0400 | [diff] [blame] | 46 | data = data[:6] + checksum(data) + data[7:] |
Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 47 | |
| 48 | # Write new rom |
| 49 | f = open(outname, 'wb') |
| 50 | f.write(data) |
Kevin O'Connor | f31bff1 | 2013-05-20 21:39:56 -0400 | [diff] [blame] | 51 | f.close() |
Kevin O'Connor | 32da6a6 | 2009-05-14 19:01:39 -0400 | [diff] [blame] | 52 | |
| 53 | if __name__ == '__main__': |
| 54 | main() |