arch/arm-raspi/kernel/kernel_cpu.c

   1 /*
   2  * This file is intended to make generic kernel.resource compiling.
   3  * This code should NEVER be executed. This file MUST be overriden in
   4  * architecture-specific code for the scheduler to work!
   5  */
   6
   7 #include <aros/kernel.h>
   8 #include <aros/libcall.h>
   9 #include <exec/execbase.h>
  10 #include <hardware/intbits.h>
  11
  12 #include <proto/kernel.h>
  13
  14 #include "etask.h"
  15
  16 #include "kernel_intern.h"
  17 #include "kernel_debug.h"
  18 #include "kernel_cpu.h"
  19 #include "kernel_syscall.h"
  20 #include "kernel_scheduler.h"
  21 #include "kernel_intr.h"
  22
  23 #define D(x)
  24 #define DREGS(x)
  25
  26 extern struct Task *sysIdleTask;
  27
  28 void cpu_Switch(regs_t *regs)
  29 {
  30     struct Task *task;
  31
  32     D(bug("[Kernel] cpu_Switch()\n"));
  33
  34     task = SysBase->ThisTask;
  35
  36     /* Copy current task's context into the ETask structure */
  37     /* Restore the task's state */
  38     STORE_TASKSTATE(task, regs)
  39
  40     /* Update the taks CPU time .. */
  41     GetIntETask(task)->iet_CpuTime += *((volatile unsigned int *)(SYSTIMER_CLO)) - GetIntETask(task)->iet_private1;
  42
  43     core_Switch();
  44 }
  45
  46 void cpu_Dispatch(regs_t *regs)
  47 {
  48     struct Task *task;
  49
  50     D(bug("[Kernel] cpu_Dispatch()\n"));
  51
  52     /* Break Disable() if needed */
  53     if (SysBase->IDNestCnt >= 0) {
  54         SysBase->IDNestCnt = -1;
  55         ((uint32_t *)regs)[13] &= ~0x80;
  56     }
  57
  58     if (!(task = core_Dispatch()))
  59         task = sysIdleTask;
  60
  61     D(bug("[Kernel] cpu_Dispatch: Letting '%s' run for a bit..\n", task->tc_Node.ln_Name));
  62
  63     /* Restore the task's state */
  64     RESTORE_TASKSTATE(task, regs)
  65
  66     DREGS(cpu_DumpRegs(regs));
  67
  68     /* Handle tasks's flags */
  69     if (task->tc_Flags & TF_EXCEPT)
  70         Exception();
  71
  72     /* Store the launch time */
  73     GetIntETask(task)->iet_private1 = *((volatile unsigned int *)(SYSTIMER_CLO));
  74
  75     if (task->tc_Flags & TF_LAUNCH)
  76     {
  77         AROS_UFC1(void, task->tc_Launch,
  78                   AROS_UFCA(struct ExecBase *, SysBase, A6));
  79     }
  80 }
  81
  82 void cpu_DumpRegs(regs_t *regs)
  83 {
  84     int i;
  85
  86     bug("[KRN] Register Dump:\n");
  87     for (i = 0; i < 12; i++)
  88     {
  89         bug("[KRN]      r%02d: 0x%08x\n", i, ((uint32_t *)regs)[i]);
  90     }
  91     bug("[KRN] (ip) r12: 0x%08x\n", ((uint32_t *)regs)[12]);
  92     bug("[KRN] (sp) r13: 0x%08x\n", ((uint32_t *)regs)[13]);
  93     bug("[KRN] (lr) r14: 0x%08x\n", ((uint32_t *)regs)[14]);
  94     bug("[KRN] (pc) r15: 0x%08x\n", ((uint32_t *)regs)[15]);
  95     bug("[KRN]     cpsr: 0x%08x\n", ((uint32_t *)regs)[16]);
  96 }