arch/arm-native/kernel/kernel_execsmp.c

   1 /*
   2     Copyright © 2015-2017, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <proto/kernel.h>
   7 #include <proto/exec.h>
   8
   9 #include <stdio.h>
  10
  11 #include "etask.h"
  12 #include "exec_intern.h"
  13
  14 #include "kernel_cpu.h"
  15
  16 #undef D
  17 #define D(x)
  18
  19 #if defined(__AROSEXEC_SMP__)
  20 extern BOOL Exec_InitETask(struct Task *, struct Task *, struct ExecBase *);
  21
  22 struct Task *cpu_InitBootStrap(struct ExecBase *SysBase)
  23 {
  24     struct ExceptionContext *bsctx;
  25     struct MemList *ml;
  26 #define bstask          ((struct Task *)(ml->ml_ME[0].me_Addr))
  27 #define bstaskmlsize    (sizeof(struct MemList) + sizeof(struct MemEntry))
  28     cpuid_t cpunum = GetCPUNumber();
  29
  30     /* Build bootstraps memory list */
  31     if ((ml = AllocMem(bstaskmlsize, MEMF_PUBLIC|MEMF_CLEAR)) == NULL)
  32     {
  33         bug("[Kernel:%02d] FATAL : Failed to allocate memory for bootstrap task", cpunum);
  34         return NULL;
  35     }
  36
  37     ml->ml_NumEntries      = 2;
  38
  39     ml->ml_ME[0].me_Length = sizeof(struct Task);
  40     if ((ml->ml_ME[0].me_Addr = AllocMem(sizeof(struct Task),    MEMF_PUBLIC|MEMF_CLEAR)) == NULL)
  41     {
  42         bug("[Kernel:%02d] FATAL : Failed to allocate task for bootstrap", cpunum);
  43         FreeMem(ml, bstaskmlsize);
  44         return NULL;
  45     }
  46
  47     /* allocate some stack space for user mode .. */
  48     ml->ml_ME[1].me_Length = 15 + (sizeof(IPTR) * 128);
  49     if ((ml->ml_ME[1].me_Addr = AllocMem(ml->ml_ME[1].me_Length, MEMF_PUBLIC|MEMF_CLEAR)) == NULL)
  50     {
  51         bug("[Kernel:%02d] FATAL : Failed to allocate stack for bootstrap task", cpunum);
  52         FreeMem(ml->ml_ME[0].me_Addr, ml->ml_ME[0].me_Length);
  53         FreeMem(ml, bstaskmlsize);
  54         return NULL;
  55     }
  56     bstask->tc_SPLower = (APTR)(((unsigned int )ml->ml_ME[1].me_Addr + 15) & ~0xF);
  57     bstask->tc_SPUpper = bstask->tc_SPLower + (sizeof(IPTR) * 128);
  58
  59     AddHead(&bstask->tc_MemEntry, &ml->ml_Node);
  60
  61     D(bug("[Kernel:%02d] Bootstrap task @ 0x%p\n", cpunum, bstask));
  62
  63     if ((bsctx = KrnCreateContext()) == NULL)
  64     {
  65         bug("[Kernel:%02d] FATAL : Failed to create the bootstrap Task context\n", cpunum);
  66         FreeMem(ml->ml_ME[1].me_Addr, ml->ml_ME[1].me_Length);
  67         FreeMem(ml->ml_ME[0].me_Addr, ml->ml_ME[0].me_Length);
  68         FreeMem(ml, bstaskmlsize);
  69         return NULL;
  70     }
  71
  72     D(bug("[Kernel:%02d] CPU Ctx @ 0x%p\n", cpunum, bsctx));
  73
  74     NEWLIST(&bstask->tc_MemEntry);
  75
  76     if ((bstask->tc_Node.ln_Name = AllocVec(20, MEMF_CLEAR)) != NULL)
  77     {
  78         sprintf(bstask->tc_Node.ln_Name, "CPU #%02d Bootstrap", cpunum);
  79     }
  80     bstask->tc_Node.ln_Type = NT_TASK;
  81     bstask->tc_Node.ln_Pri  = 0;
  82     bstask->tc_State        = TS_READY;
  83     bstask->tc_SigAlloc     = 0xFFFF;
  84
  85     /* Create a ETask structure and attach CPU context */
  86     if (!Exec_InitETask(bstask, NULL, SysBase))
  87     {
  88         bug("[Kernel:%02d] FATAL : Failed to initialize bootstrap ETask\n", cpunum);
  89         FreeVec(bstask->tc_Node.ln_Name);
  90         FreeMem(ml->ml_ME[1].me_Addr, ml->ml_ME[1].me_Length);
  91         FreeMem(ml->ml_ME[0].me_Addr, ml->ml_ME[0].me_Length);
  92         FreeMem(ml, bstaskmlsize);
  93         return NULL;
  94     }
  95     bstask->tc_UnionETask.tc_ETask->et_RegFrame = bsctx;
  96
  97     /* the bootstrap can only run on this CPU */
  98     IntETask(bstask->tc_UnionETask.tc_ETask)->iet_CpuNumber = cpunum;
  99     IntETask(bstask->tc_UnionETask.tc_ETask)->iet_CpuAffinity = (1 << cpunum);
 100
 101     bsctx->r[11] = 0;
 102     bsctx->lr = SysBase->TaskExitCode;
 103     bsctx->Flags = 0;
 104
 105     return bstask;
 106 #undef  bstask
 107 }
 108
 109 void cpu_BootStrap(struct Task *bstask, struct ExecBase *SysBase)
 110 {
 111     bstask->tc_State = TS_RUN;
 112     SET_THIS_TASK(bstask);
 113 }
 114 #endif