#include "../generic/check_compat.c"

extern long *blob_chdk_core;
extern long blob_chdk_core_size;

void __attribute__((noreturn)) my_restart()
{
    {
        long *dst = (long*)MEMISOSTART;
        const long *src = blob_chdk_core;
        long length = (blob_chdk_core_size + 3) >> 2;

  core_copy(src, dst, length);

}

    // restart function
    // from sub_FF83846C via 0x12345678
    asm volatile (
		"    MOV     R0, #0x78 \n"
		"    MCR     p15, 0, R0, c1, c0 \n"
		"    MOV     R0, #0 \n"
		"    MCR     p15, 0, R0, c7, c10, 4 \n"
		"    MCR     p15, 0, R0, c7, c5 \n"
		"    MCR     p15, 0, R0, c7, c6 \n"
		"    MOV     R0, #0x80000006 \n"
		"    MCR     p15, 0, R0, c9, c1 \n"
		"    MCR     p15, 0, R0, c9, c1, 1 \n"
		"    MRC     p15, 0, R0, c1, c0 \n"
		"    ORR     R0, R0, #0x50000 \n"
		"    MCR     p15, 0, R0, c1, c0 \n"
		"    LDR     R0, =0x12345678 \n"
		"    MOV     R1, #0x80000000 \n"
		"    STR     R0, [R1, #0xFFC] \n"
		//"    BL      sub_FF896A8C \n"  // nullsub
		//"    LDR     R0, =0xFF820000 \n"
		"MOV     R0, %0\n"              // new jump-vector
		//"    LDMFD   SP!, {R4,LR} \n"
		"    BX      R0 \n"
         : : "r"(MEMISOSTART) : "memory","r0","r1","r2","r3","r4"
        );

        while(1);
}