root/loader/sx620hs/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);
  14     }
  16     // restart function 
  17         asm volatile (
  18                 "    MOV     R0, #0x78 \n"
  19                 "    MCR     p15, 0, R0,c1,c0 \n"
  20                 "    MOV     R0, #0 \n"
  21                 "    MCR     p15, 0, R0,c7,c10, 4 \n"
  22                 "    MCR     p15, 0, R0,c7,c5 \n"
  23                 "    MCR     p15, 0, R0,c7,c6 \n"
  24                 "    MOV     R0, #0x80000006 \n"
  25                 "    MCR     p15, 0, R0,c9,c1 \n"
  26                 "    MCR     p15, 0, R0,c9,c1, 1 \n"
  27                 "    MRC     p15, 0, R0,c1,c0 \n"
  28                 "    ORR     R0, R0, #0x50000 \n"
  29                 "    MCR     p15, 0, R0,c1,c0 \n"
  30                 "    LDR     R0, =0x12345678 \n"
  31                 "    MOV     R1, #0x80000000 \n"
  32                 "    STR     R0, [R1,#0xFFC] \n"
  33 //              "    LDR     R0, =0xFF020000 \n"
  34                 "MOV     R0, %0\n"              // new jump-vector                              
  35 //              "    LDMFD   SP!, {R4,LR} \n" 
  36                 "    BX    R0 \n" 
  37                 : : "r"(MEMISOSTART) : "memory","r0","r1","r2","r3","r4"
  38         );
  39         while(1);
  40 }