arch/arm-native/kernel/kernel_execsmp.c

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