root/loader/a2400/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 {
   8         {
   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);
  15 }
  18 //** a2400 1.00e  @ 0xFF835ADC 
  19     asm volatile (
  20       "LDR     R1, =0xC0200000 \n"
  21       "MVN     R0, #0 \n"
  22       "STR     R0, [R1, #0x10C] \n"
  23       "STR     R0, [R1, #0xC] \n"
  24       "STR     R0, [R1, #0x1C] \n"
  25       "STR     R0, [R1, #0x2C] \n"
  26       "STR     R0, [R1, #0x3C] \n"
  27       "STR     R0, [R1, #0x4C] \n"
  28       "STR     R0, [R1, #0x5C] \n"
  29       "STR     R0, [R1, #0x6C] \n"
  30       "STR     R0, [R1, #0x7C] \n"
  31       "STR     R0, [R1, #0x8C] \n"
  32       "STR     R0, [R1, #0x9C] \n"
  33       "STR     R0, [R1, #0xAC] \n"
  34       "STR     R0, [R1, #0xBC] \n"
  35       "STR     R0, [R1, #0xCC] \n"
  36       "STR     R0, [R1, #0xDC] \n"
  37       "STR     R0, [R1, #0xEC] \n"
  38       "CMP     R4, #7 \n"
  39       "STR     R0, [R1, #0xFC] \n"
  40       //"LDMEQFD SP!, {R4,PC} \n"
  41       "MOV     R0, #0x78 \n"
  42       "MCR     p15, 0, R0, c1, c0 \n"
  43       "MOV     R0, #0 \n"
  44       "MCR     p15, 0, R0, c7, c10, 4 \n"
  45       "MCR     p15, 0, R0, c7, c5 \n"
  46       "MCR     p15, 0, R0, c7, c6 \n"
  47       "MOV     R0, #0x80000006 \n"
  48       "MCR     p15, 0, R0, c9, c1 \n"
  49       "MCR     p15, 0, R0, c9, c1, 1 \n"
  50       "MRC     p15, 0, R0, c1, c0 \n"
  51       "ORR     R0, R0, #0x50000 \n"
  52       "MCR     p15, 0, R0, c1, c0 \n"
  53       "LDR     R0, =0x12345678 \n"
  54       "MOV     R1, #0x80000000 \n"
  55       "STR     R0, [R1, #0xFFC] \n"
  56       // "LDR     R0, =0xFF810000 \n" //original jump-vector
  57       "MOV     R0, %0\n"              // new jump-vector
  58       "LDMFD   SP!, {R4,LR} \n"
  59       "BX      R0 \n"
  60       : : "r"(MEMISOSTART) : "memory","r0","r1","r2","r3","r4"
  61     );
  63     while(1);
  64 }