root/loader/s100/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         // S100 100d @FF02D4E0
  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 /*
  54         "CMP     R4, #3\n"
  55         "LDREQ   R1, =0x12345678\n"
  56         "MOV     R0, #0x80000000\n"
  57         "BEQ     loc_FF02D58C\n"
  58         "CMP     R4, #0xF\n"
  59         "LDREQ   R1, =0x34567812\n"
  60         "BEQ     loc_FF02D58C\n"
  61         "CMP     R4, #0x10\n"
  62         "BNE     loc_FF02D590\n"
  63         "LDR     R1, =0x45678123\n"
  64         "loc_FF02D58C:\n"
  65         "STR     R1, [R0, #0xFFC]\n"
  66         "loc_FF02D590:\n"
  67         "LDMFD   SP!, {R4,LR}\n"
  68         "MOV     R0, #0xFF000000\n"
  69 */
  70         // s100 loader hack to make power button short press work
  71         "LDR     R0, =0x12345678\n"
  72         "MOV     R1, #0x80000000\n"
  73         "STR     R0, [R1,#0xFFC]\n"
  74         "LDMFD   SP!, {R4,LR}\n"
  76         "MOV     R0, %0\n" //new jump-vector
  77         "BX      R0\n"
  78         : : "r"(MEMISOSTART) : "memory", "r0", "r1", "r2", "r3", "r4");
  80     while(1);
  81 }