root/loader/s110/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     }
  17         // resetcode here:
  18         // S110 101b @F803B30C
  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       "    LDMFD   SP!, {R4,LR} \n" 
  57       //"    MOV     R0, #0xF8000000 \n" 
  58       "    MOV     R0, %0\n" //new jump-vector
  59       "    BX      R0\n"
  60       : : "r"(MEMISOSTART) : "memory", "r0", "r1", "r2", "r3", "r4");
  62     while(1);
  63 }