arch/arm-raspi/kernel/kernel_cpu.c

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