git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@5189 35acf78f-673a-0410-8e92-d51de3d6d3f4

6 files changed, 181 insertions, 239 deletions

diff --git a/os/ports/GCC/PPC/SPC560Pxx/bam.s b/os/ports/GCC/PPC/SPC560Pxx/bam.s
index 8fbc0b53c..b5a2a6af0 100644
--- a/os/ports/GCC/PPC/SPC560Pxx/bam.s
+++ b/os/ports/GCC/PPC/SPC560Pxx/bam.s
@@ -28,10 +28,16 @@
 

 #if !defined(__DOXYGEN__)

 

-        /* BAM info, SWT off, WTE off, VLE from settings.*/

+        /* BAM record.*/

         .section    .bam, "ax"

         .long       0x015A0000

-        .long       _boot_address

+        .long       .init

+

+.init:

+        bl          _coreinit

+        bl          _ivinit

+

+        b           _boot_address

 

 #endif /* !defined(__DOXYGEN__) */

 

diff --git a/os/ports/GCC/PPC/SPC560Pxx/core.s b/os/ports/GCC/PPC/SPC560Pxx/core.s
new file mode 100644
index 000000000..246c39739
--- /dev/null
+++ b/os/ports/GCC/PPC/SPC560Pxx/core.s
@@ -0,0 +1,167 @@
+/*

+    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,

+                 2011,2012,2013 Giovanni Di Sirio.

+

+    This file is part of ChibiOS/RT.

+

+    ChibiOS/RT is free software; you can redistribute it and/or modify

+    it under the terms of the GNU General Public License as published by

+    the Free Software Foundation; either version 3 of the License, or

+    (at your option) any later version.

+

+    ChibiOS/RT is distributed in the hope that it will be useful,

+    but WITHOUT ANY WARRANTY; without even the implied warranty of

+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

+    GNU General Public License for more details.

+

+    You should have received a copy of the GNU General Public License

+    along with this program.  If not, see <http://www.gnu.org/licenses/>.

+*/

+

+/**

+ * @file    SPC560Pxx/core.s

+ * @brief   e200z0 core configuration.

+ *

+ * @addtogroup PPC_CORE

+ * @{

+ */

+

+/**

+ * @name    BUCSR registers definitions

+ * @{

+ */

+#define BUCSR_BPEN              0x00000001

+#define BUCSR_BALLOC_BFI        0x00000200

+/** @} */

+

+/**

+ * @name    BUCSR default settings

+ * @{

+ */

+#define BUCSR_DEFAULT           (BUCSR_BPEN | BUCSR_BALLOC_BFI)

+/** @} */

+

+/**

+ * @name   MSR register definitions

+ * @{

+ */

+#define MSR_WE                  0x00040000

+#define MSR_CE                  0x00020000

+#define MSR_EE                  0x00008000

+#define MSR_PR                  0x00004000

+#define MSR_ME                  0x00001000

+#define MSR_DE                  0x00000200

+#define MSR_IS                  0x00000020

+#define MSR_DS                  0x00000010

+#define MSR_RI                  0x00000002

+/** @} */

+

+/**

+ * @name   MSR default settings

+ * @{

+ */

+#define MSR_DEFAULT             (MSR_WE | MSR_CE | MSR_ME)

+/** @} */

+

+#if !defined(__DOXYGEN__)

+

+        .section    .coreinit, "ax"

+

+        .align      2

+        .globl      _coreinit

+        .type       _coreinit, @function

+_coreinit:

+        /*

+         * Branch prediction enabled.

+         */

+        li          %r3, BUCSR_DEFAULT

+        mtspr       1013, %r3       /* BUCSR */

+

+        blr

+

+        /*

+         * Exception vectors initialization.

+         */

+        .global     _ivinit

+        .type       _ivinit, @function

+_ivinit:

+        /* MSR initialization.*/

+        lis         %r3, MSR_DEFAULT@h

+        ori         %r3, %r3, MSR_DEFAULT@l

+        mtMSR       %r3

+

+        /* IVPR initialization.*/

+        lis         %r3, __ivpr_base__@h

+        ori         %r3, %r3, __ivpr_base__@l

+        mtIVPR      %r3

+

+        blr

+

+        .section    .handlers, "ax"

+

+        .globl      IVORS

+IVORS:

+IVOR0:  b           IVOR0

+        .align      4

+IVOR1:  b           _IVOR1

+        .align      4

+IVOR2:  b           _IVOR2

+        .align      4

+IVOR3:  b           _IVOR3

+        .align      4

+IVOR4:  b           _IVOR4

+        .align      4

+IVOR5:  b           _IVOR5

+        .align      4

+IVOR6:  b           _IVOR6

+        .align      4

+IVOR7:  b           _IVOR7

+        .align      4

+IVOR8:  b           _IVOR8

+        .align      4

+IVOR9:  b           _IVOR9

+        .align      4

+IVOR10: b           _IVOR10

+        .align      4

+IVOR11: b           _IVOR11

+        .align      4

+IVOR12: b           _IVOR12

+        .align      4

+IVOR13: b           _IVOR13

+        .align      4

+IVOR14: b           _IVOR14

+        .align      4

+IVOR15: b           _IVOR15

+

+        /*

+         * Unhandled exceptions handler.

+         */

+        .weak       _IVOR0,  _IVOR1,  _IVOR2,  _IVOR3,  _IVOR4,  _IVOR5

+        .weak       _IVOR6,  _IVOR7,  _IVOR8,  _IVOR9,  _IVOR10, _IVOR11

+        .weak       _IVOR12, _IVOR13, _IVOR14, _IVOR15, _IVOR32, _IVOR33

+        .weak       _IVOR34

+        .weak       _unhandled_exception

+_IVOR0:

+_IVOR1:

+_IVOR2:

+_IVOR3:

+_IVOR5:

+_IVOR6:

+_IVOR7:

+_IVOR8:

+_IVOR9:

+_IVOR11:

+_IVOR12:

+_IVOR13:

+_IVOR14:

+_IVOR15:

+_IVOR32:

+_IVOR33:

+_IVOR34:

+        .type       _unhandled_exception, @function

+_unhandled_exception:

+        b           _unhandled_exception

+

+#endif /* !defined(__DOXYGEN__) */

+

+/** @} */

diff --git a/os/ports/GCC/PPC/SPC560Pxx/ivor.s b/os/ports/GCC/PPC/SPC560Pxx/ivor.s
deleted file mode 100644
index df84fc636..000000000
--- a/os/ports/GCC/PPC/SPC560Pxx/ivor.s
+++ /dev/null
@@ -1,234 +0,0 @@
-/*

-    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,

-                 2011,2012,2013 Giovanni Di Sirio.

-

-    This file is part of ChibiOS/RT.

-

-    ChibiOS/RT is free software; you can redistribute it and/or modify

-    it under the terms of the GNU General Public License as published by

-    the Free Software Foundation; either version 3 of the License, or

-    (at your option) any later version.

-

-    ChibiOS/RT is distributed in the hope that it will be useful,

-    but WITHOUT ANY WARRANTY; without even the implied warranty of

-    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

-    GNU General Public License for more details.

-

-    You should have received a copy of the GNU General Public License

-    along with this program.  If not, see <http://www.gnu.org/licenses/>.

-*/

-

-/**

- * @file    SPC560Pxx/ivor.s

- * @brief   SPC560Pxx IVORx handlers.

- *

- * @addtogroup PPC_CORE

- * @{

- */

-

-/*

- * Imports the PPC configuration headers.

- */

-#define _FROM_ASM_

-#include "chconf.h"

-#include "chcore.h"

-

-#if !defined(__DOXYGEN__)

-        /*

-         * INTC registers address.

-         */

-        .equ  INTC_IACKR, 0xfff48010

-        .equ  INTC_EOIR,  0xfff48018

-

-        .section    .handlers, "ax"

-

-        /*

-         * Fixed IVOR offset table.

-         */

-        .globl      IVORS

-IVORS:

-IVOR0:  b           IVOR0

-        .align      4

-IVOR1:  b           _IVOR1

-        .align      4

-IVOR2:  b           _IVOR2

-        .align      4

-IVOR3:  b           _IVOR3

-        .align      4

-IVOR4:  b           _IVOR4

-        .align      4

-IVOR5:  b           _IVOR5

-        .align      4

-IVOR6:  b           _IVOR6

-        .align      4

-IVOR7:  b           _IVOR7

-        .align      4

-IVOR8:  b           _IVOR8

-        .align      4

-IVOR9:  b           _IVOR9

-        .align      4

-IVOR10: b           _IVOR10

-        .align      4

-IVOR11: b           _IVOR11

-        .align      4

-IVOR12: b           _IVOR12

-        .align      4

-IVOR13: b           _IVOR13

-        .align      4

-IVOR14: b           _IVOR14

-        .align      4

-IVOR15: b           _IVOR15

-

-        /*

-         * Unhandled exceptions handler.

-         */

-        .weak       _IVOR0

-_IVOR0:

-        .weak       _IVOR1

-_IVOR1:

-        .weak       _IVOR2

-_IVOR2:

-        .weak       _IVOR3

-_IVOR3:

-        .weak       _IVOR5

-_IVOR5:

-        .weak       _IVOR6

-_IVOR6:

-        .weak       _IVOR7

-_IVOR7:

-        .weak       _IVOR8

-_IVOR8:

-        .weak       _IVOR9

-_IVOR9:

-        .weak       _IVOR10

-_IVOR10:

-        .weak       _IVOR11

-_IVOR11:

-        .weak       _IVOR12

-_IVOR12:

-        .weak       _IVOR13

-_IVOR13:

-        .weak       _IVOR14

-_IVOR14:

-        .weak       _IVOR15

-_IVOR15:

-        .weak       _unhandled_exception

-        .type       _unhandled_exception, @function

-_unhandled_exception:

-        b           _unhandled_exception

-

-        /*

-         * IVOR4 handler (Book-E external interrupt).

-         */

-        .align		4

-        .globl      _IVOR4

-        .type       _IVOR4, @function

-_IVOR4:

-        /* Creation of the external stack frame (extctx structure).*/

-        stwu        %sp, -80(%sp)           /* Size of the extctx structure.*/

-#if PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI

-        e_stmvsrrw  8(%sp)                  /* Saves PC, MSR.               */

-        e_stmvsprw  16(%sp)                 /* Saves CR, LR, CTR, XER.      */

-        e_stmvgprw  32(%sp)                 /* Saves GPR0, GPR3...GPR12.    */

-#else /* !(PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI) */

-        stw         %r0, 32(%sp)            /* Saves GPR0.                  */

-        mfSRR0      %r0

-        stw         %r0, 8(%sp)             /* Saves PC.                    */

-        mfSRR1      %r0

-        stw         %r0, 12(%sp)            /* Saves MSR.                   */

-        mfCR        %r0

-        stw         %r0, 16(%sp)            /* Saves CR.                    */

-        mfLR        %r0

-        stw         %r0, 20(%sp)            /* Saves LR.                    */

-        mfCTR       %r0

-        stw         %r0, 24(%sp)            /* Saves CTR.                   */

-        mfXER       %r0

-        stw         %r0, 28(%sp)            /* Saves XER.                   */

-        stw         %r3, 36(%sp)            /* Saves GPR3...GPR12.          */

-        stw         %r4, 40(%sp)

-        stw         %r5, 44(%sp)

-        stw         %r6, 48(%sp)

-        stw         %r7, 52(%sp)

-        stw         %r8, 56(%sp)

-        stw         %r9, 60(%sp)

-        stw         %r10, 64(%sp)

-        stw         %r11, 68(%sp)

-        stw         %r12, 72(%sp)

-#endif /* !(PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI) */

-

-        /* Software vector address from the INTC register.*/

-        lis         %r3, INTC_IACKR@h

-        ori         %r3, %r3, INTC_IACKR@l  /* IACKR register address.      */

-        lwz         %r3, 0(%r3)             /* IACKR register value.        */

-        lwz         %r3, 0(%r3)

-        mtCTR       %r3                     /* Software handler address.    */

-

-#if PPC_USE_IRQ_PREEMPTION

-        /* Allows preemption while executing the software handler.*/

-        wrteei      1

-#endif

-

-        /* Exectes the software handler.*/

-        bctrl

-

-#if PPC_USE_IRQ_PREEMPTION

-        /* Prevents preemption again.*/

-        wrteei      0

-#endif

-

-        /* Informs the INTC that the interrupt has been served.*/

-        mbar        0

-        lis         %r3, INTC_EOIR@h

-        ori         %r3, %r3, INTC_EOIR@l

-        stw         %r3, 0(%r3)             /* Writing any value should do. */

-

-        /* Verifies if a reschedule is required.*/

-#if CH_DBG_SYSTEM_STATE_CHECK

-        bl          dbg_check_lock

-#endif

-        bl          chSchIsPreemptionRequired

-        cmpli       cr0, %r3, 0

-        beq         cr0, _ivor_exit

-        bl          chSchDoReschedule

-

-        /* Context restore.*/

-        .globl      _ivor_exit

-_ivor_exit:

-#if CH_DBG_SYSTEM_STATE_CHECK

-        bl          dbg_check_unlock

-#endif

-#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.   */

-        e_lmvsrrw  8(%sp)                   /* Restores PC, MSR.            */

-#else /*!(PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI) */

-        lwz         %r3, 36(%sp)            /* Restores GPR3...GPR12.       */

-        lwz         %r4, 40(%sp)

-        lwz         %r5, 44(%sp)

-        lwz         %r6, 48(%sp)

-        lwz         %r7, 52(%sp)

-        lwz         %r8, 56(%sp)

-        lwz         %r9, 60(%sp)

-        lwz         %r10, 64(%sp)

-        lwz         %r11, 68(%sp)

-        lwz         %r12, 72(%sp)

-        lwz         %r0, 8(%sp)

-        mtSRR0      %r0                     /* Restores PC.                 */

-        lwz         %r0, 12(%sp)

-        mtSRR1      %r0                     /* Restores MSR.                */

-        lwz         %r0, 16(%sp)

-        mtCR        %r0                     /* Restores CR.                 */

-        lwz         %r0, 20(%sp)

-        mtLR        %r0                     /* Restores LR.                 */

-        lwz         %r0, 24(%sp)

-        mtCTR       %r0                     /* Restores CTR.                */

-        lwz         %r0, 28(%sp)

-        mtXER       %r0                     /* Restores XER.                */

-        lwz         %r0, 32(%sp)            /* Restores GPR0.               */

-#endif /* !(PPC_USE_VLE && PPC_SUPPORTS_VLE_MULTI) */

-        addi        %sp, %sp, 80            /* Back to the previous frame.  */

-        rfi

-

-#endif /* !defined(__DOXYGEN__) */

-

-/** @} */

diff --git a/os/ports/GCC/PPC/SPC560Pxx/ld/SPC560P44.ld b/os/ports/GCC/PPC/SPC560Pxx/ld/SPC560P44.ld
index 675445fbe..075aae5e9 100644
--- a/os/ports/GCC/PPC/SPC560Pxx/ld/SPC560P44.ld
+++ b/os/ports/GCC/PPC/SPC560Pxx/ld/SPC560P44.ld
@@ -48,6 +48,7 @@ SECTIONS
     .boot : ALIGN(16) SUBALIGN(16)

     {

         KEEP(*(.bam))

+        KEEP(*(.coreinit))

         KEEP(*(.crt0))

         . = ALIGN(0x00000800);

         KEEP(*(.vectors))

diff --git a/os/ports/GCC/PPC/SPC560Pxx/ld/SPC560P50.ld b/os/ports/GCC/PPC/SPC560Pxx/ld/SPC560P50.ld
index 1d9f85e60..64e10aeb4 100644
--- a/os/ports/GCC/PPC/SPC560Pxx/ld/SPC560P50.ld
+++ b/os/ports/GCC/PPC/SPC560Pxx/ld/SPC560P50.ld
@@ -48,6 +48,7 @@ SECTIONS
     .boot : ALIGN(16) SUBALIGN(16)

     {

         KEEP(*(.bam))

+        KEEP(*(.coreinit))

         KEEP(*(.crt0))

         . = ALIGN(0x00000800);

         KEEP(*(.vectors))

diff --git a/os/ports/GCC/PPC/SPC560Pxx/port.mk b/os/ports/GCC/PPC/SPC560Pxx/port.mk
index d1c9dcd8e..112728112 100644
--- a/os/ports/GCC/PPC/SPC560Pxx/port.mk
+++ b/os/ports/GCC/PPC/SPC560Pxx/port.mk
@@ -2,9 +2,10 @@
 PORTSRC = ${CHIBIOS}/os/ports/GCC/PPC/chcore.c

 

 PORTASM = ${CHIBIOS}/os/ports/GCC/PPC/SPC560Pxx/bam.s \

-          ${CHIBIOS}/os/ports/GCC/PPC/crt0.s \

-          ${CHIBIOS}/os/ports/GCC/PPC/SPC560Pxx/ivor.s \

-          ${CHIBIOS}/os/ports/GCC/PPC/SPC560Pxx/vectors.s

+          ${CHIBIOS}/os/ports/GCC/PPC/SPC560Pxx/core.s \

+          ${CHIBIOS}/os/ports/GCC/PPC/SPC560Pxx/vectors.s \

+          ${CHIBIOS}/os/ports/GCC/PPC/ivor.s \

+          ${CHIBIOS}/os/ports/GCC/PPC/crt0.s

 

 PORTINC = ${CHIBIOS}/os/ports/GCC/PPC \

           ${CHIBIOS}/os/ports/GCC/PPC/SPC560Pxx