SashegDev
66 lines
2.6 KiB
Python
66 lines
2.6 KiB
Python
import struct
|
|
|
|
M = '/root/qemu-src/qemu-8.2.2/hw/arm/saimaa.c'
|
|
src = open(M).read()
|
|
|
|
start = src.find(' /* Boot scaffolding for SBL1 BringUp')
|
|
assert start > 0, 'scaffold start not found'
|
|
end_marker = 'printf("saimaa: SBL1 %s loaded'
|
|
end = src.find(end_marker, start)
|
|
assert end > 0, 'scaffold end not found'
|
|
line_start = src.rfind('\n', 0, end) + 1
|
|
|
|
blob = open('/tmp/stubs3.bin', 'rb').read()
|
|
print('stub blob len', len(blob))
|
|
c_array = ', '.join('0x%02x' % b for b in blob)
|
|
|
|
S10_A = '0x08062001'
|
|
S2 = '0x08062013'
|
|
S10_B = '0x08062021'
|
|
S6_A = '0x08062033'
|
|
|
|
new_block = ''' /* Boot scaffolding for SBL1 BringUp (WIP stub-driven PBL):
|
|
* pop-compensation stublets at 0x08062000 pin sp and route onward,
|
|
* so repeated pops always hit valid slots. */
|
|
{
|
|
static const unsigned char stub_blob[] = { %s };
|
|
uint32_t magic = 0x00000000; /* IMEM poll spins WHILE equal */
|
|
uint32_t S = 0x08062100, STUB = 0x08062120;
|
|
uint32_t w;
|
|
uint16_t h0 = 0x2000, h1 = 0x4770; /* movs r0,#0; bx lr */
|
|
size_t k;
|
|
uint32_t v;
|
|
for (k = 0; k < sizeof(stub_blob); k += 4) {
|
|
uint32_t word;
|
|
__builtin_memcpy(&word, &stub_blob[k], 4);
|
|
cpu_physical_memory_write(0x08062000 + k, &word, 4);
|
|
}
|
|
/* pointer maze in owned RAM for SBL1 struct chains */
|
|
w = S + 8;
|
|
cpu_physical_memory_write(S, &w, 4);
|
|
cpu_physical_memory_write(S + 8, &STUB, 4);
|
|
cpu_physical_memory_write(STUB, &h0, 2);
|
|
cpu_physical_memory_write(STUB + 2, &h1, 2);
|
|
cpu_physical_memory_write(0x087c29d18, &S, 4);
|
|
cpu_physical_memory_write(0x08050b28, &S, 4);
|
|
cpu_physical_memory_write(0x08070000, &S, 4);
|
|
/* pop-site slots -> stublets (sp values from cpu traces) */
|
|
v = %s; /* S1 pop10 */
|
|
cpu_physical_memory_write(0x085FFF14, &v, 4);
|
|
v = %s; /* S2 pop2 */
|
|
cpu_physical_memory_write(0x085FFF1C, &v, 4);
|
|
v = %s; /* S3 pop10 */
|
|
cpu_physical_memory_write(0x085FFF44, &v, 4);
|
|
cpu_physical_memory_write(0x085FFF7C, &v, 4);
|
|
v = %s; /* S4 pop6 (stublet chains S5) */
|
|
cpu_physical_memory_write(0x085FFF34, &v, 4);
|
|
cpu_physical_memory_write(0x08600944, &magic, 4);
|
|
printf("saimaa: stub-scaffold live\\n");
|
|
}
|
|
{
|
|
''' % (c_array, S10_A, S2, S10_B, S6_A)
|
|
|
|
src = src[:start] + new_block + src[line_start:]
|
|
open(M, 'w').write(src)
|
|
print('CANONICAL SCAFFOLD v2 OK')
|