From 60cd6f958b431b1f8268302b0636fffb7a71c538 Mon Sep 17 00:00:00 2001
From: gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4>
Date: Mon, 1 Oct 2012 14:05:32 +0000
Subject: [PATCH] git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@4730
 35acf78f-673a-0410-8e92-d51de3d6d3f4

---
 os/hal/platforms/SPC560Pxx/hal_lld.c | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/os/hal/platforms/SPC560Pxx/hal_lld.c b/os/hal/platforms/SPC560Pxx/hal_lld.c
index 7f340e6fc..822e75cb2 100644
--- a/os/hal/platforms/SPC560Pxx/hal_lld.c
+++ b/os/hal/platforms/SPC560Pxx/hal_lld.c
@@ -168,6 +168,12 @@ void spc560p_clock_init(void) {
   if (halSPC560PSetRunMode(SPC5_RUNMODE_DRUN) == CH_FAILED)
     chSysHalt();
 
+  /* CFLASH settings calculated for a maximum clock of 64MHz.*/
+  CFLASH.PFCR0.B.BK0_APC  = 2;
+  CFLASH.PFCR0.B.BK0_RWSC = 2;
+  CFLASH.PFCR1.B.BK1_APC  = 2;
+  CFLASH.PFCR1.B.BK1_RWSC = 2;
+
 #endif /* !SPC5_NO_INIT */
 }