root/loader/g11/main.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. my_restart

   1 #include "../generic/check_compat.c"
   2 
   3 extern long *blob_chdk_core;
   4 extern long blob_chdk_core_size;
   5 
   6 
   7 
   8 void __attribute__((noreturn)) my_restart() 
   9 {
  10   // DEBUG: blink led
  11   // ERR99 ToDo: Fix LED
  12   
  13   /*
  14   #define DP (void*)0xC0220138  // direct-print (blue) (G11 FW bottom)
  15   #define LED_AF (void*)0xC0223030      //LED_AF G11
  16   #define LED_ISO (void*)0xC022012C     //LED_ISO   G11
  17   #define LED_PWR (void*)0xC0220130     //LED_PWR   (G11 VF above)
  18   #define LED_BLUE (void*)0xC0220128    //LED_BLUE (G11 EV)
  19   #define DELAY 5000000
  20   
  21   volatile long *p = (void*)LED_BLUE;       // turned off later, so assumed to be power
  22   int counter;
  23 
  24   //counter = DELAY; *p = 0x46;  while (counter--) { asm("nop\n nop\n"); };
  25   //counter = DELAY; *p = 0x44;  while (counter--) { asm("nop\n nop\n"); };
  26   */
  27   
  28   long *dst = (long*)MEMISOSTART;
  29   const long *src = blob_chdk_core;
  30   long length = (blob_chdk_core_size + 3) >> 2;
  31 
  32   core_copy(src, dst, length);
  33 
  34         // resetcode here:
  35   asm volatile (
  36                         "MRS     R0, CPSR\n"
  37                         "BIC     R0, R0, #0x3F\n"
  38                         "ORR     R0, R0, #0xD3\n"
  39                         "MSR     CPSR, R0\n"
  40                         "LDR     R1, =0xC0200000\n"
  41                         "MOV    R0, #0xFFFFFFFF\n"
  42                         "STR     R0, [R1,#0x10C]\n"
  43                         "STR     R0, [R1,#0xC]\n"
  44                         "STR     R0, [R1,#0x1C]\n"
  45                         "STR     R0, [R1,#0x2C]\n"
  46                         "STR     R0, [R1,#0x3C]\n"
  47                         "STR     R0, [R1,#0x4C]\n"
  48                         "STR     R0, [R1,#0x5C]\n"
  49                         "STR     R0, [R1,#0x6C]\n"
  50                         "STR     R0, [R1,#0x7C]\n"
  51                         "STR     R0, [R1,#0x8C]\n"
  52                         "STR     R0, [R1,#0x9C]\n"
  53                         "STR     R0, [R1,#0xAC]\n"
  54                         "STR     R0, [R1,#0xBC]\n"
  55                         "STR     R0, [R1,#0xCC]\n"
  56                         "STR     R0, [R1,#0xDC]\n"
  57                         "STR     R0, [R1,#0xEC]\n"
  58 //                      "CMP     R4, #7\n"
  59                         "STR     R0, [R1,#0xFC]\n"
  60 //                      "LDMEQFD SP!, {R4,PC}\n"
  61                         "MOV     R0, #0x78\n"
  62                         "MCR     p15, 0, R0,c1,c0\n"
  63                         "MOV     R0, #0\n"
  64                         "MCR     p15, 0, R0,c7,c10, 4\n"
  65                         "MCR     p15, 0, R0,c7,c5\n"
  66                         "MCR     p15, 0, R0,c7,c6\n"
  67                         "MOV     R0, #0x80000006\n"
  68                         "MCR     p15, 0, R0,c9,c1\n"
  69                         "MCR     p15, 0, R0,c9,c1, 1\n"
  70                         "MRC     p15, 0, R0,c1,c0\n"
  71                         "ORR     R0, R0, #0x50000\n"
  72                         "MCR     p15, 0, R0,c1,c0\n"
  73                         "LDR     R0, =0x12345678\n"
  74                         "MOV     R1, #0x80000000\n"
  75                         "STR     R0, [R1,#0xFFC]\n"
  76           //"LDR     R0, =0xFF810000\n"   // original jump-vector
  77             "MOV     R0, %0\n"              // new jump-vector
  78                         "LDMFD   SP!, {R4,LR}\n"
  79                         "BX      R0\n"
  80                         : : "r"(MEMISOSTART) : "memory","r0","r1","r2","r3","r4");
  81   while(1);
  82 }

/* [<][>][^][v][top][bottom][index][help] */