rom/kernel/kernel_scheduler.c

   1 #include <exec/alerts.h>
   2 #include <exec/execbase.h>
   3 #include <proto/exec.h>
   4
   5 #include <kernel_base.h>
   6 #include <kernel_debug.h>
   7 #include <kernel_scheduler.h>
   8
   9 #define D(x)
  10
  11 /*
  12  * Schedule the currently running task away. Put it into the TaskReady list
  13  * in some smart way. This function is subject of change and it will be probably replaced
  14  * by some plugin system in the future
  15  */
  16 BOOL core_Schedule(void)
  17 {
  18     struct Task *task = SysBase->ThisTask;
  19
  20     D(bug("[KRN] core_Schedule()\n"));
  21
  22     SysBase->AttnResched &= ~ARF_AttnSwitch;
  23
  24     /* If task has pending exception, reschedule it so that the dispatcher may handle the exception */
  25     if (!(task->tc_Flags & TF_EXCEPT))
  26     {
  27         BYTE pri;
  28
  29         /* Is the TaskReady empty? If yes, then the running task is the only one. Let it work */
  30         if (IsListEmpty(&SysBase->TaskReady))
  31             return FALSE;
  32
  33         /* Does the TaskReady list contains tasks with priority equal or lower than current task?
  34          * If so, then check further... */
  35         pri = ((struct Task*)GetHead(&SysBase->TaskReady))->tc_Node.ln_Pri;
  36         if (pri <= task->tc_Node.ln_Pri)
  37         {
  38             /* If the running task did not used it's whole quantum yet, let it work */
  39             if (!(SysBase->SysFlags & SFF_QuantumOver))
  40                 return FALSE;
  41         }
  42     }
  43
  44     /*
  45      * If we got here, then the rescheduling is necessary.
  46      * Put the task into the TaskReady list.
  47      */
  48     D(bug("[KRN] Setting task 0x%p (%s) to READY\n", task, task->tc_Node.ln_Name));
  49     task->tc_State = TS_READY;
  50     Enqueue(&SysBase->TaskReady, &task->tc_Node);
  51
  52     /* Select new task to run */
  53     return TRUE;
  54 }
  55
  56 /* Actually switch away from the task */
  57 void core_Switch(void)
  58 {
  59     struct Task *task = SysBase->ThisTask;
  60
  61     D(bug("[KRN] core_Switch(): Old task = %p (%s)\n", task, task->tc_Node.ln_Name));
  62
  63     task->tc_IDNestCnt = SysBase->IDNestCnt;
  64
  65     if (task->tc_Flags & TF_SWITCH)
  66         AROS_UFC1(void, task->tc_Switch, AROS_UFCA(struct ExecBase *, SysBase, A6));
  67 }
  68
  69 /*
  70  * Task dispatcher. Basically it may be the same one no matter
  71  * what scheduling algorithm is used (except SysBase->Elapsed reloading)
  72  */
  73 struct Task *core_Dispatch(void)
  74 {
  75     struct Task *task;
  76
  77     D(bug("[KRN] core_Dispatch()\n"));
  78
  79     task = (struct Task *)REMHEAD(&SysBase->TaskReady);
  80     if (!task)
  81     {
  82         /* Is the list of ready tasks empty? Well, go idle. */
  83         D(bug("[KRN] No ready tasks, entering sleep mode\n"));
  84
  85         /* Idle counter is incremented every time when we enter here,
  86            not only once. This is correct. */
  87         SysBase->IdleCount++;
  88         SysBase->AttnResched |= ARF_AttnSwitch;
  89
  90         return NULL;
  91     }
  92
  93     SysBase->DispCount++;
  94
  95     SysBase->IDNestCnt = task->tc_IDNestCnt;
  96     SysBase->ThisTask = task;
  97     SysBase->Elapsed = SysBase->Quantum;
  98     SysBase->SysFlags &= ~SFF_QuantumOver;
  99     task->tc_State = TS_RUN;
 100
 101     D(bug("[KRN] New task = %p (%s)\n", task, task->tc_Node.ln_Name));
 102
 103     /*
 104      * Check the stack of the task we are about to launch.
 105      * Unfortunately original m68k programs can change stack manually without updating SPLower or SPUpper.
 106      * For example WB3.1 C:SetPatch adds exec/OpenDevice() patch that swaps stacks manually.
 107      * Result is that _all_ programs that call OpenDevice() crash if stack is checked.
 108      */
 109 #ifndef __mc68000
 110     if (task->tc_SPReg <= task->tc_SPLower || task->tc_SPReg > task->tc_SPUpper)
 111     {
 112         bug("[KRN] Task %s went out of stack limits\n", task->tc_Node.ln_Name);
 113         bug("[KRN] Lower %p, upper %p, SP %p\n", task->tc_SPLower, task->tc_SPUpper, task->tc_SPReg);
 114         Alert(AT_DeadEnd|AN_StackProbe);
 115     }
 116 #endif
 117     if (task->tc_Flags & TF_LAUNCH)
 118         AROS_UFC1(void, task->tc_Launch, AROS_UFCA(struct ExecBase *, SysBase, A6));
 119
 120     /* Leave interrupt and jump to the new task */
 121     return task;
 122 }