1 #include "../generic/check_compat.c"
2
3 extern long *blob_chdk_core;
4 extern long blob_chdk_core_size;
5
6 // DEBUG: blink led
7 //#define LED_AF 0xc022d200
8 //#define DELAY 5000000
9
10 void __attribute__((noreturn)) my_restart()
11 {
12 // DEBUG: blink led
13 // volatile long *p1 = (void*)LED_AF;
14 //int counter;
15 //counter = DELAY; *p1 = 0x93d800; while (counter--) { asm("nop\n nop\n"); };
16 //counter = DELAY; *p1 = 0x83dc00; while (counter--) { asm("nop\n nop\n"); };
17 {
18 long *dst = (long*)MEMISOSTART;
19 const long *src = blob_chdk_core;
20 long length = (blob_chdk_core_size + 3) >> 2;
21
22 core_copy(src, dst, length);
23 }
24
25 // restart function
26 asm volatile (
27 " MOV R0, #0x78 \n"
28 " MCR p15, 0, R0, c1, c0 \n"
29 " MOV R0, #0 \n"
30 " MCR p15, 0, R0, c7, c10, 4 \n"
31 " MCR p15, 0, R0, c7, c5 \n"
32 " MCR p15, 0, R0, c7, c6 \n"
33 " MOV R0, #0x80000006 \n"
34 " MCR p15, 0, R0, c9, c1 \n"
35 " MCR p15, 0, R0, c9, c1, 1 \n"
36 " MRC p15, 0, R0, c1, c0 \n"
37 " ORR R0, R0, #0x50000 \n"
38 " MCR p15, 0, R0, c1, c0 \n"
39 " LDR R0, =0x23456789 \n"
40 " MOV R1, #0x80000000 \n"
41 //" STR R0, [R1, #0xFFC] \n"
42 //" LDR R0, =sub_FF020000 \n"
43 " MOV R0, %0\n" // new jump-vector
44 " BLX R0 \n"
45 " MOV R0, #1 \n"
46 //" LDMFD SP!, {R4,PC} \n"
47 : : "r"(MEMISOSTART) : "memory","r0","r1","r2","r3","r4"
48 );
49
50 while(1);
51 }
52