arch/arm-native/exec/platform_init.c

   1 /*
   2     Copyright © 2013, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 1
   7
   8 #include <aros/debug.h>
   9 #include <aros/cpu.h>
  10 #include <aros/kernel.h>
  11 #include <aros/symbolsets.h>
  12 #include <exec/memory.h>
  13 #include <exec/tasks.h>
  14 #include <exec/alerts.h>
  15 #include <exec/execbase.h>
  16 #include <asm/io.h>
  17
  18 #include <proto/exec.h>
  19 #include <proto/kernel.h>
  20
  21 #include <strings.h>
  22 #include <stdio.h>
  23
  24 #include "kernel_cpu.h"
  25 #include "kernel_ipi.h"
  26
  27 #include "exec_intern.h"
  28 #if defined(__AROSEXEC_SMP__)
  29 #include "etask.h"
  30 #endif
  31
  32 /* Linked from kernel.resource,
  33  * need to retrieve in a cleaner fashion .. */
  34 extern IPTR stack[];
  35
  36 extern void IdleTask(struct ExecBase *);
  37
  38 int Exec_ARMCPUInit(struct ExecBase *SysBase)
  39 {
  40     struct Task *BootTask, *CPUIdleTask;
  41 #if defined(__AROSEXEC_SMP__)
  42     int cpu, cpunum = KrnGetCPUCount();
  43 #endif
  44     char *taskName;
  45
  46     D(bug("[Exec] %s()\n", __PRETTY_FUNCTION__));
  47
  48     BootTask = GET_THIS_TASK;
  49
  50     D(bug("[Exec] %s: launched from %s @ 0x%p\n", __PRETTY_FUNCTION__, BootTask->tc_Node.ln_Name, BootTask));
  51
  52 #if defined(__AROSEXEC_SMP__)
  53     if (cpunum == 0)
  54     {
  55 #endif
  56         /* for our sanity we will tell exec about the correct stack for the boot task */
  57         BootTask->tc_SPLower = stack;
  58         BootTask->tc_SPUpper = stack + AROS_STACKSIZE;
  59 #if defined(__AROSEXEC_SMP__)
  60     }
  61
  62     for (cpu = 0; cpu < cpunum; cpu ++)
  63     {
  64         taskName = AllocVec(15, MEMF_CLEAR);
  65         sprintf( taskName, "CPU #%02d Idle", cpu);
  66 #else
  67     taskName = "System Idle";
  68 #endif
  69         CPUIdleTask = NewCreateTask(TASKTAG_NAME   , taskName,
  70 #if defined(__AROSEXEC_SMP__)
  71                                 TASKTAG_AFFINITY   , KrnGetCPUMask(cpu),
  72 #endif
  73                                 TASKTAG_PRI        , -127,
  74                                 TASKTAG_PC         , IdleTask,
  75                                 TASKTAG_ARG1       , SysBase,
  76                                 TAG_DONE);
  77
  78         if (CPUIdleTask)
  79         {
  80             D(
  81                 bug("[Exec] %s: %s Task created @ 0x%p\n", __PRETTY_FUNCTION__, CPUIdleTask->tc_Node.ln_Name, CPUIdleTask);
  82 #if defined(__AROSEXEC_SMP__)
  83                 bug("[Exec] %s: CPU Affinity : %08x\n", __PRETTY_FUNCTION__, GetIntETask(CPUIdleTask)->iet_CpuAffinity);
  84 #endif
  85             )
  86         }
  87 #if defined(__AROSEXEC_SMP__)
  88     }
  89 #endif
  90
  91     return TRUE;
  92 }
  93
  94 #if defined(__AROSEXEC_SMP__)
  95 struct Hook Exec_TaskSpinLockFailHook;
  96
  97 AROS_UFH3(void, Exec_TaskSpinLockFailFunc,
  98     AROS_UFHA(struct Hook *, h, A0),
  99     AROS_UFHA(spinlock_t *, thisLock, A1),
 100     AROS_UFHA(void *, unused, A2))
 101 {
 102     AROS_USERFUNC_INIT
 103
 104     struct Task *thisTask = GET_THIS_TASK;
 105
 106     /* tell the schedular that the task is waiting on a spinlock */
 107     thisTask->tc_State = TS_SPIN;
 108     GetIntETask(thisTask)->iet_SpinLock = thisLock;
 109
 110     AROS_USERFUNC_EXIT
 111 }
 112
 113 void Exec_TaskSpinUnlock(spinlock_t *thisLock)
 114 {
 115     struct Task *curTask, *nxtTask;
 116
 117     Kernel_43_KrnSpinLock(&PrivExecBase(SysBase)->TaskSpinningLock, NULL,
 118                 SPINLOCK_MODE_WRITE, NULL);
 119     ForeachNodeSafe(&PrivExecBase(SysBase)->TaskSpinning, curTask, nxtTask)
 120     {
 121         if (GetIntETask(curTask)->iet_SpinLock == thisLock)
 122         {
 123             Kernel_43_KrnSpinLock(&PrivExecBase(SysBase)->TaskReadySpinLock, NULL,
 124                 SPINLOCK_MODE_WRITE, NULL);
 125             Disable();
 126             Remove(&curTask->tc_Node);
 127             Enqueue(&SysBase->TaskReady, &curTask->tc_Node);
 128             Kernel_44_KrnSpinUnLock(&PrivExecBase(SysBase)->TaskReadySpinLock, NULL);
 129             Enable();
 130         }
 131     }
 132     Kernel_44_KrnSpinUnLock(&PrivExecBase(SysBase)->TaskSpinningLock, NULL);
 133 }
 134
 135 int Exec_ARMCPUSMPInit(struct ExecBase *SysBase)
 136 {
 137     int cpu, thiscpu = KrnGetCPUNumber();
 138
 139     /* setup the task spinning hook */
 140     Exec_TaskSpinLockFailHook.h_Entry = (HOOKFUNC)Exec_TaskSpinLockFailFunc;
 141
 142     D(bug("[Exec] %s: Task SpinLock Fail hook @ 0x%p initialised (func @ 0x%p)\n", __PRETTY_FUNCTION__, &Exec_TaskSpinLockFailHook, Exec_TaskSpinLockFailHook.h_Entry));
 143 #if (0)
 144     for (cpu = 1; cpu < 4; cpu++)
 145     {
 146         __arm_arosintern.ARMI_SendIPI((IPI_SCHEDULE & 0x0fffffff) | (thiscpu << 28), 0, KrnGetCPUMask(cpu));
 147     }
 148 #endif
 149 }
 150
 151 ADD2INITLIB(Exec_ARMCPUSMPInit, -127)
 152 #endif
 153
 154 ADD2INITLIB(Exec_ARMCPUInit, 0)