root/loader/g5x/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 {
check_compat();
  10     long *dst = (long*)MEMISOSTART;
  11     const long *src = blob_chdk_core;
  12     long length = (blob_chdk_core_size + 3) >> 2;
core_copy(src, dst, length);
  16     // light up green LED
  17     *(volatile int*)0xd20b0994 = 0x4d0002;
  18     // blinker
  19     /*
  20     while(1) {
  21         int i;
  22         *(volatile int*)0xd20b0994 = 0x4d0002;
  23         for(i=0;i<1000000;i++) {
  24             asm volatile(
  25             "nop\n"
  26             );
  27         }
  28         *(volatile int*)0xd20b0994 = 0x4c0003;
  29         for(i=0;i<1000000;i++) {
  30             asm volatile(
  31             "nop\n"
  32             );
  33         }
  34     }
  35     */
  37     asm volatile (
  38     "mov     r1, %1\n"
  39     "mov     r0, %0\n"
  40     "ldr     r2, =0xFC150D5B\n" // address is OK for 100c
  41     "blx     r2\n"              // caching related routine called at fw startup
  42     "mov     r0, %0\n"
  43     "add     r0, r0, #1\n"
  44     "bx      r0\n"
  45     : : "r"(MEMISOSTART), "r"(((blob_chdk_core_size+3)>>2)<<2) : "memory","r0","r1","r2","r3","r4"
  46     );
  47     while(1);
  48 }