From 665640ba0afdd833f5a727a0741208d0282f01bb Mon Sep 17 00:00:00 2001
From: gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4>
Date: Wed, 20 Nov 2013 10:13:46 +0000
Subject: git-svn-id:
 svn://svn.code.sf.net/p/chibios/svn/branches/kernel_3_dev@6500
 35acf78f-673a-0410-8e92-d51de3d6d3f4

---
 os/common/ports/e200/compilers/GCC/ivor.s | 25 +++++++++++++++++++++----
 1 file changed, 21 insertions(+), 4 deletions(-)

(limited to 'os/common')

diff --git a/os/common/ports/e200/compilers/GCC/ivor.s b/os/common/ports/e200/compilers/GCC/ivor.s
index 2f000c531..6d24c0b30 100644
--- a/os/common/ports/e200/compilers/GCC/ivor.s
+++ b/os/common/ports/e200/compilers/GCC/ivor.s
@@ -58,8 +58,8 @@
         .globl      _IVOR10
         .type       _IVOR10, @function
 _IVOR10:
-        /* Creation of the external stack frame (extctx structure).*/
-        stwu        %sp, -80(%sp)           /* Size of the extctx structure.*/
+        /* Saving the external context (port_extctx structure).*/
+        stwu        %sp, -80(%sp)
 #if PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI
         e_stmvsrrw  8(%sp)                  /* Saves PC, MSR.               */
         e_stmvsprw  16(%sp)                 /* Saves CR, LR, CTR, XER.      */
@@ -90,6 +90,11 @@ _IVOR10:
         stw         %r12, 72(%sp)
 #endif /* !(PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI) */
 
+        /* Increasing the SPGR0 register.*/
+        mfspr       %r0, 272
+        eaddi       %r0, %r0, 1
+        mtspr       272, %r0
+
         /* Reset DIE bit in TSR register.*/
         lis         %r3, 0x0800             /* DIS bit mask.                */
         mtspr       336, %r3                /* TSR register.                */
@@ -122,8 +127,8 @@ _IVOR10:
         .globl      _IVOR4
         .type       _IVOR4, @function
 _IVOR4:
-        /* Creation of the external stack frame (extctx structure).*/
-        stwu        %sp, -80(%sp)           /* Size of the extctx structure.*/
+        /* Saving the external context (port_extctx structure).*/
+        stwu        %sp, -80(%sp)
 #if PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI
         e_stmvsrrw  8(%sp)                  /* Saves PC, MSR.               */
         e_stmvsprw  16(%sp)                 /* Saves CR, LR, CTR, XER.      */
@@ -154,6 +159,11 @@ _IVOR4:
         stw         %r12, 72(%sp)
 #endif /* !(PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI) */
 
+        /* Increasing the SPGR0 register.*/
+        mfspr       %r0, 272
+        eaddi       %r0, %r0, 1
+        mtspr       272, %r0
+
         /* Software vector address from the INTC register.*/
         lis         %r3, INTC_IACKR@h
         ori         %r3, %r3, INTC_IACKR@l  /* IACKR register address.      */
@@ -195,6 +205,13 @@ _ivor_exit:
 #if CH_DBG_SYSTEM_STATE_CHECK
         bl          dbg_check_unlock
 #endif
+
+        /* Decreasing the SPGR0 register.*/
+        mfspr       %r0, 272
+        eaddi       %r0, %r0, -1
+        mtspr       272, %r0
+
+        /* Restoring the external context.*/
 #if PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI
         e_lmvgprw   32(%sp)                 /* Restores GPR0, GPR3...GPR12. */
         e_lmvsprw   16(%sp)                 /* Restores CR, LR, CTR, XER.   */
-- 
cgit v1.2.3