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

1 files changed, 22 insertions, 2 deletions

diff --git a/os/hal/platforms/SPC56ELxx/hal_lld.c b/os/hal/platforms/SPC56ELxx/hal_lld.c
index 32915f161..d31e91f75 100644
--- a/os/hal/platforms/SPC56ELxx/hal_lld.c
+++ b/os/hal/platforms/SPC56ELxx/hal_lld.c
@@ -118,8 +118,28 @@ void spc_early_init(void) {
      invalid accesses to peripherals.*/

   SSCM.ERROR.R = 3;                             /* PAE and RAE bits.        */

 

+  /* FCCU CF errors clearing.*/

+  FCCU.CFK.R        = 0x618B7A50;

+  FCCU.CFS[0].R     = 0xFFFFFFFF;

+  while (FCCU.CTRL.B.OPS != 3)

+    ;

+  FCCU.CFK.R        = 0x618B7A50;

+  FCCU.CFS[1].R     = 0xFFFFFFFF;

+  while (FCCU.CTRL.B.OPS != 3)

+    ;

+

+  /* FCCU NCF errors clearing.*/

+  FCCU.NCFK.R       = 0xAB3498FE;

+  FCCU.NCFS[0].R    = 0xFFFFFFFF;

+  while (FCCU.CTRL.B.OPS != 3)

+    ;

+

+  /* RGM errors clearing.*/

+  RGM.FES.R         = 0xFFFF;

+  RGM.DES.R         = 0xFFFF;

+

   /* Enabling peripheral bridges to allow any operation.*/

-  AIPS.MPROT.R      = 0x77777777;

+/*  AIPS.MPROT.R      = 0x77777777;

   AIPS.PACR0_7.R    = 0;

   AIPS.PACR8_15.R   = 0;

   AIPS.PACR16_23.R  = 0;

@@ -135,7 +155,7 @@ void spc_early_init(void) {
   AIPS.OPACR64_71.R = 0;

   AIPS.OPACR72_79.R = 0;

   AIPS.OPACR80_87.R = 0;

-  AIPS.OPACR88_95.R = 0;

+  AIPS.OPACR88_95.R = 0;*/

 

   /* The system must be in DRUN mode on entry, if this is not the case then

      it is considered a serious anomaly.*/