cleanup..
[rpi-open-firmware.git] / romstage.c
index b71a8dd..2fb84d0 100644 (file)
@@ -112,12 +112,14 @@ void switch_vpu_to_pllc() {
        CM_TIMERCTL = CM_PASSWORD | CM_SRC_OSC | 0x10;\r
 }\r
 \r
        CM_TIMERCTL = CM_PASSWORD | CM_SRC_OSC | 0x10;\r
 }\r
 \r
-void set_interrupt(int intno, bool enable) {\r
+void set_interrupt(int intno, bool enable, int core) {\r
+    int base = (core == 0) ? IC0_BASE : IC1_BASE;\r
+\r
     int offset = 0x10 + ((intno >> 3) << 2);\r
     uint32_t slot = 0xF << ((intno & 7) << 2);\r
 \r
     int offset = 0x10 + ((intno >> 3) << 2);\r
     uint32_t slot = 0xF << ((intno & 7) << 2);\r
 \r
-    uint32_t v = mmio_read32(IC0_BASE + offset) & ~slot;\r
-    mmio_write32(IC0_BASE + offset, enable ? v | slot : v);\r
+    uint32_t v = mmio_read32(base + offset) & ~slot;\r
+    mmio_write32(base + offset, enable ? v | slot : v);\r
 }\r
 \r
 extern void sdram_init();\r
 }\r
 \r
 extern void sdram_init();\r
@@ -131,22 +133,20 @@ int _main(unsigned int cpuid, unsigned int load_address) {
        uart_init();\r
 \r
        for(int i = 0; i < 64; ++i) {\r
        uart_init();\r
 \r
        for(int i = 0; i < 64; ++i) {\r
-           set_interrupt(i, (i != (125 - 64)) && (i != (121 - 64)) && (i != (120 - 64)) && (i != (73 - 64)) && (i != (96 - 64)));\r
+           set_interrupt(i, (i != (125 - 64)) && (i != (121 - 64)) && (i != (120 - 64)) && (i != (73 - 64)) && (i != (96 - 64)), 0);\r
+           set_interrupt(i, 0, 1);\r
        }\r
 \r
        }\r
 \r
-       led_init();\r
+       IC0_VADDR = 0x1B000;\r
+       IC1_VADDR = 0x1B000;\r
+\r
+       __asm__ volatile("ei");\r
 \r
        printf(\r
 \r
        printf(\r
-           "==================================================================\n"\r
-           "::\n"\r
-           ":: kFW for bcm270x, Copyright 2016-2017 rpi-open-firmware authors \n"\r
-           "::\n"\r
-           ":: BUILDATE  : %s %s \n"\r
-           ":: BUILDSTYLE: %s \n"\r
-           "::\n"\r
-           "==================================================================\n",\r
+           "Booting Raspberry Pi....\n"\r
+           "Copyright 2016-2017 rpi-open-firmware authors \n"\r
+           "BUILDATE  : %s %s \n",\r
            __DATE__, __TIME__,\r
            __DATE__, __TIME__,\r
-           "OPENSOURCE"\r
        );\r
 \r
        g_CPUID = cpuid;\r
        );\r
 \r
        g_CPUID = cpuid;\r
This page took 0.034212 seconds and 4 git commands to generate.