arch/ppc/mpc55xx/kernel/arch_krn.sx

   1 \r
   2 /*\r
   3  * IVOR4\r
   4  * 1. Save stack frames: EXC, VGPR, NVGPR and C\r
   5  * 2. Call IntCtrl_Entry(void *curr_stack)\r
   6  * 2.1 Check for exception\r
   7  * 2.2 If softint, clear it.\r
   8  * 2.3 If PROC_ISR1, then just call the function\r
   9  * 2.4 If PROC_ISR2 -> it's a PCB, let the OS handle it.\r
  10  */\r
  11 \r
  12 #define _ASSEMBLER_\r
  13 #include "asm_ppc.h"\r
  14 #include "asm_offset.h"\r
  15 #include "asm_book_e.h"\r
  16 .extern os_intc_pcb_tbl\r
  17 .extern os_intc_types_tbl\r
  18 .extern os_sys\r
  19 \r
  20 \r
  21 /*\r
  22  * Small assembler school\r
  23  * Compare imm(32-bit)\r
  24  * > cmpwi rA,100\r
  25  * Extract bits and right adjust\r
  26  * > extrwi rA,rS,n,b  ( n-number of bits, b- startbit )\r
  27  *\r
  28  * Note!\r
  29  * The offset's (d or D)for SPE instructins are rediculously low.\r
  30  * Normally you have 16-bits offset, but when using spe load and store\r
  31  * you can use only 8-bit.\r
  32 */\r
  33 \r
  34 #define LOCK()                  wrteei  0\r
  35 #define UNLOCK()                wrteei  1\r
  36 \r
  37 \r
  38 .extern os_proc_start_extended\r
  39 \r
  40 //-------------------------------------------------------------------\r
  41 \r
  42     .global os_exception_IVOR8\r
  43     .balign 16\r
  44 os_exception_IVOR8:\r
  45         stwu    sp,-(EXC_SIZE+VGPR_SIZE)(sp)\r
  46         stw     r3,EXC_R3_OFF(r1)\r
  47         stw     r4,EXC_R4_OFF(r1)\r
  48         SAVE_EXC_FRAME(3,1,0,SPR_SRR0,SPR_SRR1)\r
  49         SAVE_VGPR(1,EXC_SIZE);\r
  50         li              r3,328\r
  51         stw     r3,EXC_VECTOR_OFF(r1)\r
  52 \r
  53         rfi\r
  54 \r
  55 dummy_int:\r
  56                 b dummy_int\r
  57 \r
  58 /*--------------------------------------------------------------------\r
  59  * void os_swap_context(pcb_t *old, pcb_t *new )\r
  60  *\r
  61  * Saves a small context on current stack, pops a new one from new context\r
  62  *\r
  63  * r3 - pcb for old process\r
  64  * r4 - pcb for new process\r
  65  *\r
  66  *--------------------------------------------------------------------*/\r
  67 \r
  68 // TODO: this assumes that both are in user mode?.. can this happen under trusted functions?\r
  69 //       When I get here we're ALWAYS in kernel mode\r
  70 \r
  71 .global os_arch_swap_context_to\r
  72 .global os_arch_swap_context\r
  73 .section .text\r
  74 os_arch_swap_context:\r
  75                 // allocate space for context+nvgpr\r
  76                 // (no need for proper stack-frame here)\r
  77                 stwu    r1,-(C_SIZE+NVGPR_SIZE)(r1)\r
  78                 // save lr and cr */\r
  79                 mflr    r0\r
  80                 stw             r0,C_LR_OFF(sp)\r
  81                 mfcr    r0\r
  82                 stw             r0,C_CR_OFF(sp)\r
  83                 // Save small-context pattern\r
  84                 li              r0,SC_PATTERN\r
  85                 stw             r0,C_CONTEXT_OFF(sp)\r
  86                 // Save registers preserved by function call\r
  87                 SAVE_NVGPR(sp,(C_SIZE-14*GPR_SIZE))\r
  88 // Save stack ptr...\r
  89                 stw             sp,PCB_STACK_CURR_P(r3)\r
  90 \r
  91 // Stack frame here\r
  92 // --------- bottom( high address )\r
  93 //  SC_xxx\r
  94 //  C_xxx\r
  95 // --------- <- stack.curr\r
  96 //\r
  97 // --------- top( low address )\r
  98 \r
  99 \r
 100 // TODO: If we change application we must change mmu setup\r
 101 os_arch_swap_context_to:\r
 102 // Get stack for new task\r
 103                 lwz             sp,PCB_STACK_CURR_P(r4)\r
 104 \r
 105 // Set new current process\r
 106                 LOAD_ADDR_32(3,os_sys)\r
 107                 stw             r4,SYS_CURR_PCB_P(r3)\r
 108 \r
 109 // Restore C context\r
 110         lwz     r0,C_CR_OFF(sp)\r
 111         mtcr    r0\r
 112         lwz     r0,C_LR_OFF (sp)\r
 113         mtlr    r0\r
 114 \r
 115 // Get the context type\r
 116                 lwz             r0,C_CONTEXT_OFF(sp)\r
 117                 cmpli   0,r0,SC_PATTERN\r
 118                 beq+    os_sc_restore\r
 119                 cmpli   0,r0,LC_PATTERN\r
 120                 beq+    os_lc_restore\r
 121                 b               os_bad_bad\r
 122 \r
 123 \r
 124 // SC_xxx\r
 125 // C_xxxx <- We point here\r
 126 \r
 127 os_sc_restore:\r
 128                 RESTORE_NVGPR(sp,(C_SIZE-14*GPR_SIZE))\r
 129                 addi    sp,sp,(C_SIZE+NVGPR_SIZE)\r
 130                 // TODO: The blr will not do the trick if swapping to a user land task.\r
 131                 blr\r
 132 \r
 133 os_lc_restore:\r
 134         addi    r1,r1,C_SIZE\r
 135         RESTORE_NVGPR(1,0)\r
 136         addi    r1,r1,-C_SIZE\r
 137         RESTORE_VGPR(1,C_SIZE)\r
 138 \r
 139         RESTORE_WORK_AND_MORE\r
 140         rfi\r
 141 \r
 142 // When something really bad happens we end up here for the moment\r
 143 os_bad_bad:\r
 144                 b       os_bad_bad\r
 145 \r
 146 \r
 147 \r
 148 \r
 149 // ------------------------------------------------------------------\r
 150 \r
 151 /*\r
 152  * Trap interface !!!! See article http://www.linuxjournal.com/article/6516\r
 153  * http://www.osweekly.com/index.php?option=com_content&task=view&id=2229\r
 154  */\r
 155 \r
 156 /* The T32 instruction sim can't handle trap's so we have to make something\r
 157  * - write SRR0, SRR1, MSR\r
 158  * - jump to there routines\r
 159  */\r
 160 \r
 161 // ------------------------------------------------------------------\r
 162 \r
 163 \r
 164 // System call, use this for trusted function ???\r
 165 // TODO: The example in autosar is not neccesary.. sc here here instead??\r
 166 //\r
 167 // NOTE!!!!!\r
 168 // Since the sc is a sync call, it should be enough to save NV regs(14->)\r
 169 // If I don't use the NV regs here I shouldn't need to save them\r
 170 // TODO: Inform compiler in SC_CALL() that I clobber volatile regs( r0, r3->\r
 171 //      (since the compiler does not know it's a function call)\r
 172 // TODO: Could probably do this shorter....only NV regs that I use need saving\r
 173 //       ( only cr2->cr4 according to e500 ABI )\r
 174 \r
 175 \r
 176 \r
 177 \r
 178 \r
 179 \r