arch/ppc-sam440/kernel/syscall.c

   1 #include <asm/amcc440.h>
   2 #include "kernel_intern.h"
   3 #include "syscall.h"
   4
   5 extern char * __text_start;
   6 extern char * __text_end;
   7
   8 void __attribute__((noreturn)) syscall_handler(regs_t *ctx, uint8_t exception, void *self)
   9 {
  10     struct KernelBase *KernelBase = getKernelBase();
  11
  12 //    D(bug("[KRN] SysCall handler. context @ %p SC=%d\n", ctx, ctx->gpr[3]));
  13
  14     if ((char*)ctx->srr0 < &__text_start || (char*)ctx->srr0 >= &__text_end)
  15     {
  16         D(bug("[KRN] ERROR ERROR! SysCall issued directly outside kernel.resource!!!!!\n"));
  17         core_LeaveInterrupt(ctx);
  18     }
  19
  20     switch (ctx->gpr[3])
  21     {
  22         case SC_CLI:
  23             ctx->srr1 &= ~MSR_EE;
  24             break;
  25
  26         case SC_STI:
  27             ctx->srr1 |= MSR_EE;
  28             break;
  29
  30         case SC_SUPERSTATE:
  31             ctx->srr1 &= ~MSR_PR;
  32             break;
  33
  34         case SC_ISSUPERSTATE:
  35             if (ctx->srr1 & MSR_PR)
  36                 ctx->gpr[3] = 0;
  37             else
  38                 ctx->gpr[3] = 1;
  39             break;
  40
  41         case SC_CAUSE:
  42             {
  43                 struct ExecBase *SysBase = getSysBase();
  44                 if (SysBase)
  45                     core_Cause(SysBase);
  46             }
  47             break;
  48
  49         case SC_DISPATCH:
  50             core_Dispatch(ctx);
  51             break;
  52
  53         case SC_SWITCH:
  54             core_Switch(ctx);
  55             break;
  56
  57         case SC_SCHEDULE:
  58             core_Schedule(ctx);
  59             break;
  60
  61         case SC_INVALIDATED:
  62         {
  63             char *start = (char*)((IPTR)ctx->gpr[4] & 0xffffffe0);
  64             char *end = (char*)(((IPTR)ctx->gpr[4] + ctx->gpr[5] + 31) & 0xffffffe0);
  65             char *ptr;
  66
  67             for (ptr = start; ptr < end; ptr +=32)
  68             {
  69                 asm volatile("dcbi 0,%0"::"r"(ptr));
  70             }
  71             asm volatile("sync");
  72         }
  73     }
  74
  75     core_LeaveInterrupt(ctx);
  76 }