root/loader/d30/main.c

DEFINITIONS

1. my_restart

   1 #include "../generic/check_compat.c"
   3 extern long *blob_chdk_core;
   4 extern long blob_chdk_core_size;
   6 void __attribute__((noreturn)) my_restart()
   7 {
   9         long *dst = (long*)MEMISOSTART;
  10     const long *src = blob_chdk_core;
  11     long length = (blob_chdk_core_size + 3) >> 2;
core_copy(src, dst, length);
  16     //d30 100a @ 0xFF025CDC
  17     asm volatile (
  18 "    LDR     R1, =0xC0200000 \n"
  19 "    MVN     R0, #0 \n"
  20 "    STR     R0, [R1, #0x10C] \n"
  21 "    STR     R0, [R1, #0xC] \n"
  22 "    STR     R0, [R1, #0x1C] \n"
  23 "    STR     R0, [R1, #0x2C] \n"
  24 "    STR     R0, [R1, #0x3C] \n"
  25 "    STR     R0, [R1, #0x4C] \n"
  26 "    STR     R0, [R1, #0x5C] \n"
  27 "    STR     R0, [R1, #0x6C] \n"
  28 "    STR     R0, [R1, #0x7C] \n"
  29 "    STR     R0, [R1, #0x8C] \n"
  30 "    STR     R0, [R1, #0x9C] \n"
  31 "    STR     R0, [R1, #0xAC] \n"
  32 "    STR     R0, [R1, #0xBC] \n"
  33 "    STR     R0, [R1, #0xCC] \n"
  34 "    STR     R0, [R1, #0xDC] \n"
  35 "    STR     R0, [R1, #0xEC] \n"
  36 "    CMP     R4, #7 \n"
  37 "    STR     R0, [R1, #0xFC] \n"
  38 // "    LDMEQFD SP!, {R4,PC} \n"
  39 "    MOV     R0, #0x78 \n"
  40 "    MCR     p15, 0, R0, c1, c0 \n"
  41 "    MOV     R0, #0 \n"
  42 "    MCR     p15, 0, R0, c7, c10, 4 \n"
  43 "    MCR     p15, 0, R0, c7, c5 \n"
  44 "    MCR     p15, 0, R0, c7, c6 \n"
  45 "    MOV     R0, #0x80000006 \n"
  46 "    MCR     p15, 0, R0, c9, c1 \n"
  47 "    MCR     p15, 0, R0, c9, c1, 1 \n"
  48 "    MRC     p15, 0, R0, c1, c0 \n"
  49 "    ORR     R0, R0, #0x50000 \n"
  50 "    MCR     p15, 0, R0, c1, c0 \n"
  51 "    LDR     R0, =0x12345678 \n"
  52 "    MOV     R1, #0x80000000 \n"
  53 "    STR     R0, [R1, #0xFFC] \n"
  54 "    LDMFD   SP!, {R4,LR} \n"
  55 // "    MOV     R0, #0xFF000000 \n"
  56 "    MOV     R0, %0\n"               //new jump-vector
  57 "    BX      R0 \n"
  58         : : "r"(MEMISOSTART) : "memory","r0","r1","r2","r3","r4"
  59     );
  60     while(1);
  61 }