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 "exec_intern.h"
  25 #if defined(__AROSEXEC_SMP__)
  26 #include "etask.h"
  27 #endif
  28
  29 /* Linked from kernel.resource,
  30  * need to retrieve in a cleaner fashion .. */
  31 extern IPTR stack[];
  32
  33 extern void IdleTask(struct ExecBase *);
  34
  35 int Exec_ARMCPUInit(struct ExecBase *SysBase)
  36 {
  37     struct Task *BootTask, *CPUIdleTask;
  38     int cpu, cpunum = KrnGetCPUCount();
  39     char *taskName;
  40
  41     D(bug("[Exec] %s()\n", __PRETTY_FUNCTION__));
  42
  43     BootTask = GET_THIS_TASK;
  44
  45     D(bug("[Exec] %s: launched from %s @ 0x%p\n", __PRETTY_FUNCTION__, BootTask->tc_Node.ln_Name, BootTask));
  46
  47     if (cpunum == 0)
  48     {
  49         /* for our sanity we will tell exec about the correct stack for the boot task */
  50         BootTask->tc_SPLower = stack;
  51         BootTask->tc_SPUpper = stack + AROS_STACKSIZE;
  52     }
  53
  54 #if defined(__AROSEXEC_SMP__)
  55     for (cpu = 0; cpu < cpunum; cpu ++)
  56     {
  57         taskName = AllocVec(15, MEMF_CLEAR);
  58         sprintf( taskName, "CPU #%02d Idle", cpu);
  59 #else
  60     taskName = "System Idle";
  61 #endif
  62         CPUIdleTask = NewCreateTask(TASKTAG_NAME   , taskName,
  63 #if defined(__AROSEXEC_SMP__)
  64                                 TASKTAG_AFFINITY   , KrnGetCPUMask(cpu),
  65 #endif
  66                                 TASKTAG_PRI        , -127,
  67                                 TASKTAG_PC         , IdleTask,
  68                                 TASKTAG_ARG1       , SysBase,
  69                                 TAG_DONE);
  70
  71         if (CPUIdleTask)
  72         {
  73             D(
  74                 bug("[Exec] %s: %s Task created @ 0x%p\n", __PRETTY_FUNCTION__, CPUIdleTask->tc_Node.ln_Name, CPUIdleTask);
  75 #if defined(__AROSEXEC_SMP__)
  76                 bug("[Exec] %s: CPU Affinity : %08x\n", __PRETTY_FUNCTION__, GetIntETask(CPUIdleTask)->iet_CpuAffinity);
  77 #endif
  78             )
  79         }
  80 #if defined(__AROSEXEC_SMP__)
  81     }
  82 #endif
  83
  84     return TRUE;
  85 }
  86
  87 #if defined(__AROSEXEC_SMP__)
  88 struct Hook Exec_TaskSpinLockFailHook;
  89
  90 AROS_UFH3(void, Exec_TaskSpinLockFailFunc,
  91     AROS_UFHA(struct Hook *, h, A0),
  92     AROS_UFHA(spinlock_t *, thisLock, A1),
  93     AROS_UFHA(void *, unused, A2))
  94 {
  95     AROS_USERFUNC_INIT
  96
  97     struct Task *thisTask = GET_THIS_TASK;
  98
  99     /* tell the schedular that the task is waiting on a spinlock */
 100     thisTask->tc_State = TS_SPIN;
 101     GetIntETask(thisTask)->iet_SpinLock = thisLock;
 102
 103     AROS_USERFUNC_EXIT
 104 }
 105
 106 void Exec_TaskSpinUnlock(spinlock_t *thisLock)
 107 {
 108     struct Task *curTask, *nxtTask;
 109
 110     Kernel_43_KrnSpinLock(&PrivExecBase(SysBase)->TaskSpinningLock, NULL,
 111                 SPINLOCK_MODE_WRITE, NULL);
 112     ForeachNodeSafe(&PrivExecBase(SysBase)->TaskSpinning, curTask, nxtTask)
 113     {
 114         if (GetIntETask(curTask)->iet_SpinLock == thisLock)
 115         {
 116             Kernel_43_KrnSpinLock(&PrivExecBase(SysBase)->TaskReadySpinLock, NULL,
 117                 SPINLOCK_MODE_WRITE, NULL);
 118             Disable();
 119             Remove(&curTask->tc_Node);
 120             Enqueue(&SysBase->TaskReady, &curTask->tc_Node);
 121             Kernel_44_KrnSpinUnLock(&PrivExecBase(SysBase)->TaskReadySpinLock, NULL);
 122             Enable();
 123         }
 124     }
 125     Kernel_44_KrnSpinUnLock(&PrivExecBase(SysBase)->TaskSpinningLock, NULL);
 126 }
 127
 128 int Exec_TaskSpinningInit(struct ExecBase *SysBase)
 129 {
 130     /* setup the task spinning hook */
 131     Exec_TaskSpinLockFailHook.h_Entry = (HOOKFUNC)Exec_TaskSpinLockFailFunc;
 132
 133     D(bug("[Exec] %s: Task SpinLock Fail hook @ 0x%p initialised (func @ 0x%p)\n", __PRETTY_FUNCTION__, &Exec_TaskSpinLockFailHook, Exec_TaskSpinLockFailHook.h_Entry));
 134 }
 135
 136 ADD2INITLIB(Exec_TaskSpinningInit, -127)
 137 #endif
 138
 139 ADD2INITLIB(Exec_ARMCPUInit, 0)