arch/arm-native/kernel/kernel_startup.c

   1 /*
   2     Copyright © 2013-2015, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 1
   7
   8 #include <aros/kernel.h>
   9 #include <aros/symbolsets.h>
  10
  11 #include <aros/arm/cpucontext.h>
  12
  13 #include <aros/cpu.h>
  14
  15 #include <exec/memory.h>
  16 #include <exec/memheaderext.h>
  17 #include <exec/tasks.h>
  18 #include <exec/alerts.h>
  19 #include <exec/execbase.h>
  20 #include <asm/io.h>
  21 #include <proto/kernel.h>
  22 #include <proto/exec.h>
  23 #include <strings.h>
  24
  25 #include "exec_intern.h"
  26 #include "etask.h"
  27
  28 #include "tlsf.h"
  29
  30 #include "kernel_intern.h"
  31 #include "kernel_debug.h"
  32 #include "kernel_romtags.h"
  33
  34 #include "exec_platform.h"
  35
  36 #if defined(__AROSEXEC_SMP__)
  37 extern void Kernel_40_KrnSpinInit(spinlock_t *, void *);
  38 #endif
  39
  40 extern struct TagItem *BootMsg;
  41
  42 void __attribute__((used)) kernel_cstart(struct TagItem *msg);
  43
  44 uint32_t stack[AROS_STACKSIZE] __attribute__((used,aligned(16)));
  45 static uint32_t stack_super[AROS_STACKSIZE] __attribute__((used,aligned(16)));
  46
  47 static uint32_t stack_fiq[1024] __attribute__((used,aligned(16)));
  48
  49 asm (
  50     ".section .aros.init,\"ax\"\n\t"
  51     ".globl start\n\t"
  52     ".type start,%function\n"
  53     "start:\n"
  54     "           push {r0}                    \n"
  55     "           bl      __clear_bss          \n"
  56     "           pop {r0}                     \n"
  57     "           cps     #0x1f                \n" /* system mode */
  58     "           ldr     sp, stack_end        \n"
  59     "           cps     #0x11                \n" /* fiq mode */
  60     "           ldr     sp, stack_fiq_end    \n"
  61     "           cps     #0x13                \n" /* SVC (supervisor) mode */
  62     "           ldr     sp, stack_super_end  \n"
  63     "           b       kernel_cstart        \n"
  64
  65     ".string \"Native/CORE v3 (" __DATE__ ")\"" "\n\t\n\t"
  66 );
  67
  68 static uint32_t * const stack_end __attribute__((used, section(".aros.init"))) = &stack[AROS_STACKSIZE - sizeof(IPTR)];
  69 static uint32_t * const stack_super_end __attribute__((used, section(".aros.init"))) = &stack_super[AROS_STACKSIZE - sizeof(IPTR)];
  70 static uint32_t * const stack_fiq_end __attribute__((used, section(".aros.init"))) = &stack_fiq[1024 - sizeof(IPTR)];
  71
  72
  73 struct ARM_Implementation __arm_arosintern  __attribute__((aligned(4), section(".data"))) = {0,0,NULL,NULL};
  74 struct ExecBase *SysBase __attribute__((section(".data"))) = NULL;
  75
  76 static void __attribute__((used)) __clear_bss(struct TagItem *msg)
  77 {
  78     struct KernelBSS *bss = (struct KernelBSS *)krnGetTagData(KRN_KernelBss, 0, msg);
  79     register unsigned int dest;
  80     unsigned int length;
  81
  82     if (bss)
  83     {
  84         while (bss->addr && bss->len)
  85         {
  86             dest = (unsigned int)bss->addr;
  87             length = bss->len;
  88
  89             // If the start address is unaligned, fill in the first 1-3 bytes until it is
  90             while((dest & 3) && length)
  91             {
  92                 *((unsigned char *)dest) = 0;
  93                 dest++;
  94                 length--;
  95             }
  96
  97             // Fill in the remaining 32-bit word-aligned memory locations
  98             while(length & 0xfffffffc)
  99             {
 100                 *((unsigned int *)dest) = 0;
 101                 dest += 4;
 102                 length -= 4;
 103             }
 104
 105             // Deal with the remaining 1-3 bytes, if any
 106             while(length)
 107             {
 108                 dest++;
 109                 length--;
 110                 *((unsigned char *)dest) = 0;
 111             }
 112             bss++;
 113         }
 114     }
 115 }
 116
 117 extern uint32_t __arm_affinitymask;
 118
 119 void __attribute__((used)) kernel_cstart(struct TagItem *msg)
 120 {
 121     UWORD *ranges[3];
 122     struct MinList memList;
 123     struct MemHeader *mh;
 124     struct MemChunk *mc;
 125     long unsigned int memlower = 0, memupper = 0, protlower = 0, protupper = 0;
 126     char *cmdline = NULL;
 127     BootMsg = msg;
 128     tls_t *__tls;
 129
 130     // Probe the ARM core
 131     cpu_Probe(&__arm_arosintern);
 132
 133     // Probe the ARM Implementation/Platform
 134     __arm_arosintern.ARMI_Platform = 0;
 135     while(msg->ti_Tag != TAG_DONE)
 136     {
 137         switch (msg->ti_Tag)
 138         {
 139         case KRN_Platform:
 140             __arm_arosintern.ARMI_Platform = msg->ti_Data;
 141             break;
 142         }
 143         msg++;
 144     }
 145     msg = BootMsg;
 146
 147     platform_Init(&__arm_arosintern, msg);
 148
 149     if (__arm_arosintern.ARMI_LED_Toggle)
 150     {
 151         if (__arm_arosintern.ARMI_Delay)
 152             __arm_arosintern.ARMI_Delay(100000);
 153         __arm_arosintern.ARMI_LED_Toggle(ARM_LED_POWER, ARM_LED_OFF);
 154     }
 155
 156     cpu_Init(&__arm_arosintern, msg);
 157
 158     if (__arm_arosintern.ARMI_LED_Toggle)
 159     {
 160         if (__arm_arosintern.ARMI_Delay)
 161             __arm_arosintern.ARMI_Delay(100000);
 162         __arm_arosintern.ARMI_LED_Toggle(ARM_LED_POWER, ARM_LED_ON);
 163     }
 164
 165     /* NB: the bootstrap has conveniently setup the framebuffer
 166             and initialised the serial port and led for us */
 167
 168     while(msg->ti_Tag != TAG_DONE)
 169     {
 170         switch (msg->ti_Tag)
 171         {
 172         case KRN_CmdLine:
 173 //            RelocateStringData(tag);
 174             cmdline = (char *)msg->ti_Data;
 175             break;
 176         case KRN_MEMLower:
 177             memlower = msg->ti_Data;
 178             break;
 179         case KRN_MEMUpper:
 180             memupper = msg->ti_Data;
 181             break;
 182         case KRN_ProtAreaStart:
 183             protlower = msg->ti_Data;
 184             break;
 185         case KRN_ProtAreaEnd:
 186             // Page align
 187             protupper = (msg->ti_Data + 4095) & ~4095;
 188             break;
 189         case KRN_KernelBase:
 190             /*
 191              * KRN_KernelBase is actually a border between read-only
 192              * (code) and read-write (data) sections of the kickstart.
 193              * read-write section goes to lower addresses from this one,
 194              * so we align it upwards in order not to make part of RW data
 195              * read-only.
 196              */
 197 //            addr = AROS_ROUNDUP2(msg->ti_Data, PAGE_SIZE);
 198             break;
 199         }
 200         msg++;
 201     }
 202     msg = BootMsg;
 203
 204     __tls = (void *)protupper;
 205     protupper += (sizeof(tls_t) + 4095) & ~4095;
 206
 207     __tls->KernelBase = NULL;
 208     __tls->SysBase = NULL;
 209     __tls->ThisTask = NULL;
 210
 211     D(bug("[KRN] AROS ARM Native Kernel built on %s\n", __DATE__));
 212
 213     D(bug("[KRN] Entered kernel_cstart @ 0x%p, BootMsg @ 0x%p\n", kernel_cstart, BootMsg));
 214
 215     asm volatile("mcr p15, 0, %0, c13, c0, 3" : : "r"(__tls));
 216
 217     D(
 218         if (__arm_arosintern.ARMI_PutChar)
 219         {
 220             bug("[KRN] Using PutChar implementation @ %p\n", __arm_arosintern.ARMI_PutChar);
 221         }
 222         bug("[KRN] Boot CPU TLS @ 0x%p\n", __tls);
 223     )
 224
 225     core_SetupIntr();
 226
 227     if (__arm_arosintern.ARMI_LED_Toggle)
 228         __arm_arosintern.ARMI_LED_Toggle(ARM_LED_POWER, ARM_LED_OFF);
 229
 230     D(bug("[KRN] Platform initialised\n"));
 231     D(bug("[KRN] Affinity mask %08x\n", __arm_affinitymask));
 232
 233     if (__arm_arosintern.ARMI_Delay)
 234             __arm_arosintern.ARMI_Delay(1500);
 235
 236     if (__arm_arosintern.ARMI_LED_Toggle)
 237         __arm_arosintern.ARMI_LED_Toggle(ARM_LED_POWER, ARM_LED_ON);
 238
 239     D(bug("[KRN] Preparing memory 0x%p -> 0x%p\n", memlower, memupper));
 240     D(bug("[KRN] (protected area 0x%p -> 0x%p)\n", protlower, protupper));
 241
 242     NEWLIST(&memList);
 243
 244     if (memlower >= protlower)
 245         memlower = protupper;
 246
 247     mh = (struct MemHeader *)memlower;
 248
 249     if (cmdline && strstr(cmdline, "notlsf"))
 250     {
 251 #if (0)
 252         krnCreateMemHeader("System Memory", 0, mh, (memupper - memlower), MEMF_FAST | MEMF_PUBLIC | MEMF_KICK | MEMF_LOCAL);
 253
 254         if (memlower < protlower)
 255         {
 256 //            AllocAbs(protupper-protlower, (void *)protlower);
 257         }
 258 #endif
 259     }
 260     else
 261     {
 262         /* Initialize TLSF memory allocator */
 263         krnCreateTLSFMemHeader("System Memory", 0, mh, (memupper - memlower), MEMF_FAST | MEMF_PUBLIC | MEMF_KICK | MEMF_LOCAL);
 264         if (memlower < protlower)
 265         {
 266             /* Protect the bootstrap area from further use. AllocAbs will do the trick */
 267             ((struct MemHeaderExt *)mh)->mhe_AllocAbs((struct MemHeaderExt *)mh, protupper-protlower, (void *)protlower);
 268         }
 269     }
 270
 271     ranges[0] = (UWORD *)krnGetTagData(KRN_KernelLowest, 0, msg);
 272     ranges[1] = (UWORD *)krnGetTagData(KRN_KernelHighest, 0, msg);
 273     ranges[2] = (UWORD *)-1;
 274
 275     D(bug("[KRN] Preparing ExecBase (memheader @ 0x%p)\n", mh));
 276     krnPrepareExecBase(ranges, mh, BootMsg);
 277
 278     __tls->SysBase = SysBase;
 279     D(bug("[KRN] SysBase @ 0x%p\n", SysBase));
 280
 281 #if defined(__AROSEXEC_SMP__)
 282     /* Initialise exec spinlocks */
 283     Kernel_40_KrnSpinInit(&PrivExecBase(SysBase)->TaskReadySpinLock, NULL);
 284     Kernel_40_KrnSpinInit(&PrivExecBase(SysBase)->TaskWaitSpinLock, NULL);
 285 #endif
 286
 287     /*
 288      * Make kickstart code area read-only.
 289      * We do it only after ExecBase creation because SysBase pointer is put
 290      * into .rodata. This way we prevent it from ocassional modification by buggy software.
 291      */
 292 //    core_ProtKernelArea(addr, kick_highest - addr, 1, 0, 1);
 293
 294     D(bug("[KRN] InitCode(RTF_SINGLETASK) ... \n"));
 295     InitCode(RTF_SINGLETASK, 0);
 296
 297     D(bug("[KRN] Dropping into USER mode ... \n"));
 298     asm("cps %[mode_user]\n" : : [mode_user] "I" (CPUMODE_USER)); /* switch to user mode */
 299
 300     D(bug("[KRN] InitCode(RTF_COLDSTART) ...\n"));
 301     InitCode(RTF_COLDSTART, 0);
 302
 303     /* The above should not return */
 304     krnPanic(KernelBase, "System Boot Failed!");
 305 }
 306
 307 DEFINESET(ARMPLATFORMS);